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ABSTRACT 

Two  robust  rate  control  system  designs  are  carried  out  for  a  sub- 
mersible (modeled  by  the  NSRDC  2510  equations)  in  a  turn  using  the  Linear 
Quadratic  Gaussian  approach  with  Loop  Transfer  Recovery.   Separate  com- 
mand channels  allow  the  submersible  to  maneuver  independently  in  the 
horizontal  and  vertical  planes;  the  vehicle  operator  controls  the  bearing 
rate  and  depth  rate  through  a  joystick-like  device.   The  fin  configuration 
is  the  conventional  cruciform  stern  without  differential  control. 

The  first  compensator  design,  called  the  r  -  6  controller  in  this 
thesis,  directly  controls  two  vehicle  state  variables;  pitch  (6)  and  the 
vehicle  angular  velocity,  r,  about  the  z-axis.   The  other  system,  called 
the  iji  -  z  controller,  controls  yaw  (or  heading)  rate  (^)  and  depth  rate 
(z)  directly.   However,  this  design  relies  on  linearized  equations  of  yaw 
and  depth  rate  to  be  employed  by  the  compensator  for  state  reconstruction. 

A  tool  for  Kalman  Filter  loop  shaping  is  developed  in  which  state 
variables  are  scaled  to  provide  good  loop  shapes  and  then  recovered  to 
get  controllers  that  are  robust.   Both  controllers  are  compared  on  the 
basis  of  performance  in  a  nonlinear  simulation.   A  robustness  comparison 
is  also  conducted. 

Based  on  limited  simulation  data,  this  thesis  concludes  that  the 
^  -  z  controller  provides  better  control  of  depth  rate  than  the  r  -  6 
controller.   Bearing  rate  performance  is  essentially  equal  in  both  de- 
signs.  However,  the  i>   -    z   controller  appears  less  robust  in  certain 
frequency  ranges. 
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CHAPTER  1 


INTRODUCTION 


1.1    Background 

The  submarine  operator's  objective  is  to  maneuver  his  vehicle 
freely  in  the  ocean  environment  with  respect  to  depth,  heading,  and 
speed.   In  some  situations,  such  as  transits  and  partrols,  the  operator's 
task  is  simplified  to  maintaining  the  submarine's  depth,  heading,  and 
speed  essentially  constant.   Such  maneuvering  requirements  are  easily 
accomplished  by  the  crewmembers  of  the  submersible.   On  the  other  hand, 
docking,  turning,  and  performing  evasive  maneuvers  to  avoid  navigation 
hazards  or  enemy  torpedos  are  instances  where  the  submarine's  depth, 
heading,  and  speed  may  have  to  be  varied  suddenly.   Obviously  these 
maneuvers  must  be  carried  out  safely  and  effectively.   However,  there  are 
many  environmental  and  design  obstacles  that  inhibit  the  operator  from 
fully  controlling  this  process.   These  impediments  include  a  cruciform 
stern  without  differential  control;  cross-coupling  of  the  planes  of  motion 
(due  primarily  to  the  large  sail  area) ,  variable  hydrodynamic  forces 
(vorticity,  turbulence) ,  and  a  limited  ability  to  "see"  the  environment 
(no  windows)  . 

Largely  through  experience  and  familiarity  with  the  vehicle 
dynamic  response,  the  conning  officer  learns  that  certain  rudder  angle/pitch 
angle  orders  will  result  in  a  certain  heading  rate  and  depth  rate  for  a 
given  speed.   Rules  of  thumb  have  been  developed  for  ordering  the  appro- 
priate amount  of  pitch  angle  to  accomplish  the  required  depth  change  and 
for  an  appropriate  amount  of  stern  plane  angle  to  offset  the  vehicle's 
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tendency  to  dive  in  a  turn.   It  is  particularly  difficult  for  the  conning 
officer  to  simultaneously  command  the  turn  rate  and  pitch  angle  due  to 
the  interaction  of  complex  dynamics.   The  operator's  control  task  be- 
comes increasingly  difficult  as  the  severity  of  the  maneuver  increases. 
One  would  therefore  seek  to  eliminate  much  of  the  guesswork  associated 
with  performing  these  maneuvers  by  providing  more  substantial  means  of 
controlling  the  transient  dynamics  of  the  submarine. 

It  is  the  intent  of  this  thesis  to  demonstrate  a  procedure  for  a 
truly  multivariable  control  system  design  that  would  provide  the  operator 
with  a  means  of  achieving  desired  submarine  motion  in  depth  and  heading 
through  rate  control.   The  multiple  input  -  multiple  output  (MIMO)  de- 
sign methodologies  based  on  the  MIMO-LQG  formulation  of  Stein  and  Doyle 
[1]  will  form  the  theoretical  basis  of  this  thesis.   Specifically  the 
novel  MIMO-LQG/LTR  approach  proposed  by  Athans  [2]  for  model  based  com- 
pensators will  be  followed  in  this  controller  design.   Importantly, 
this  methodology  permits  the  design  of  dynamic  compensators  without  the 
need  for  full  state  feedback.   This  will  allow  the  development  of  a 
"robust"  controller  that  is  tolerant  of  modeling  errors,  nonlinearities, 
and  noise. 

1.2    Outline  of  Thesis 

Chapter  2  first  introduces  submarine  dynamics  and  developes  the 
linear  models  that  will  be  used  for  two  different  control  system  designs 
at  30  knots.   The  last  section  of  the  chapter  will  provide  the  desired 
controller  design  specifications  to  be  adhered  to  in  the  remainder  of 
this  design. 

In  Chapter  3  the  theory  that  provides  the  basis  for  the  LQG-LTR 
process  is  introduced. 

Chapter  4  is  the  design  procedure  chapter  for  the  two  controller 
designs.   A  method  to  produce  consistent  Kalman  Filter  loop  shapes  is 
developed. 
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In  Chapter  5  the  obtained  designs  are  evaluated  through  computer 
simulation  and  comparisons  are  made. 

Chapter  6  contains  the  summary  and  suggestions  for  further  study. 
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CHAPTER  2 


THE  NONLINEAR  SUBMARINE  MODEL 


2 . 1    Introduction  to  Submersible  Modeling 

Submersible  dynamics  of  motion  and  attitude  can  be  described  in  a 
variety  of  coordinate  systems.  For  the  purpose  of  developing  a  model  of 
submersible  motion,  the  equations  of  motion  are  expressed  in  the  body 
fixed  axis  because  hydrodynamic  forces  and  inertia  are  most  readily  com- 
puted in  a  ship  reference  frame.  From  the  aspect  of  ship  guidance  and 
control,  on  the  other  hand,  it  may  be  desirable  to  describe  motion,  such 
as  vehicle  course  and  depth,  in  terms  of  an  earth  reference  frame. 

General  dynamical  equations  have  been  developed  for  the  descrip- 
tion of  ocean  vehicle  motion.   These  represent  equalities  of  Newtonian 
force  and  moment  expressions,  on  the  left  hand  side,  and  the  so  called 
dynamical  response  terms  on  the  right  hand  side: 

=      f  (dynamical  response  terms)  (2-1) 

-»- 

The   general   form  of   the   force   expression    (Newton)    is: 

■*•  d  d         -*■ 

"T     =     — ■    (momentum)       =     —    (mU   ) 

**  dt  dt  G 
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where 


U   =   iu  +  jv  +  kw 


and  the  moment  expression  is 


■>  d  d  -> 

U,    =     —    (angular  momentum)      =     —    (I£0 
" ,v>  at  at  G 


where 


-*■  -»-->--> 

Q     =      xp   +   jq  +   kr 


(The  definitions  of  u,  v,  w,  p,  q,  and  r  are  found  in  Table  2-1). 

The  subscript  G  indicates  the  origin  to  coincide  with  a  body-fixed 
coordinate  system  located  at  the  vehicle  center  of  gravity.   However,  the 
reference  point  is  seldom  taken  there  since  the  center  of  gravity  moves 
with  shifting  weights  inside  the  vehicle.   Instead,  the  coordinate  sys- 
tem is  generally  taken  about  the  submersible  center  of  buoyancy,  and  so 
provides  a  useful  location  for  hydrodynamic  estimates.   This  point  is  a 
function  of  vehicle  geometry  and  is  therefore  fixed.   The  left  hand  side 
equations  become  somewhat  more  involved  due  to  this  coordinate  system 
transformation  and  will  not  be  discussed  further.   Details  of  these 
terms  and  simplifcations  commonly  used  for  ocean  vehicle  dynamics  can 
be  found  in  reference  [3] . 

The  dynamical  response  terms  of  the  right  hand  side  of  Eq.  (2-1) 
are  presented  in  Appendix  A.   These  terms  express  the  external  forces 
and  moments  exerted  on  the  vehicle  by  hydrodynamic,  control  surface, 
propulsion,  and  other  effects. 

The  force  and  moment  equalities  of  Eq.  (2-1)  describe  the  six  pos- 
sible degrees  of  freedom  of  the  submersible.   The  three  forces  are  in 
the  axial,  lateral,  and  normal  directions,  which  give  rise  to  motions 
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Table  2-1.   Definitions  of  submarine  states  and  controls. 


Submarine  States 


State 


Definition 


Units 


u  =  Component  of  U  in  direction  of  x  axis     (ft/s) 
v  =  Component  of  U  in  direction  of  y  axis     (ft/s) 

w  =  Component  of  U  in  direction  of  z  axis     (ft/s) 

->■ 
p  =  Component  of  Q   about  x  axis  (rad/s) 

-> 
q  =  Component  of  9,   about  y  axis  (rad/s) 

-*■ 
r   =  Component  of  0.   about  z  axis  (rad/s) 

<j>   =  Angular  rotation  (roll)  about  the        (radians) 
x  axis 

0   =  Angular  rotation  (pitch)  about  the       (radians) 
y  axis 

Submarine  Controls 

6r:  deflection  of  rudder 

6s:  deflection  of  stern  plane 

5b:  deflection  of  sail  planes 

RPS:  shaft  revolutions  per  second 
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of  surge,  sway,  and  heave  respectively.   The  three  moment  equations  pro- 
duce moments  and  motion  of  roll,  pitch,  and  yaw.   Figure  2-1  shows  the 
positive  directions  of  forces,  moments,  motions,  and  control  surface 
deflections. 

2.2    The  Nonlinear  Computer  Model 

The  nonlinear  model  used  for  this  design  was  derived  from  the 
original  NSRDC  2510  document  "Standard  Equations  of  Motion  for  Submarine 
Simulation"  [4] .   These  equations  have  since  been  improved  to  include 
crossflow  drag  and  vortex  contributions.   This  model  is  installed  on  the 
computer  system  at  the  Charles  Stark  Draper  Laboratories.   The  nonlinear 
model  used  in  this  thesis  consists  of  8  differential  equations  to  describe 
the  submarine  dynamics.   The  six  equations  derived  from  the  force  and 
moment  equalities  account  for  the  states  u,  v,  w,  p,  q,  and  r.   The  de- 
pendence of  these  states  on  hydrostatic  restoring  forces  about  the  pitch 
and  roll  axis  and  their  kinematic  relations  result  in  two  additional 
states,  $  and  9.   The  definitions  of  these  states  are  listed  in  Table  2-1. 

At  this  point,  it  will  suffice  to  state  that  ship  motion  in  open 
water  is  not  sensitive  to  heading  angle;  on  the  other  hand,  the  dynamics 
of  a  submersible  are  affected  by  changes  in  buoyant  forces  brought  about 
by  moderate  depth  excursions.   These  forces  were  not  accounted  for  in 
the  submarine  model  and,  hence,  depth  is  not  included  as  a  state  in  the 
system  equations.   By  choice,  propulsion  plant  dynamics  were  excluded 
in  this  model;  the  resulting  propeller  dynamics  in  an  actual  submarine 
vary,  depending  on  the  operating  procedure  of  engineering  plant  personnel 
and  would  be  difficult  to  model.   Moreover,  the  model  in  its  current  ver- 
sion does  not  include  either  the  actuator  dynamics,  or  the  actual  angle 
rate  limits  of  the  control  surfaces.   Due  to  the  importance  of  actuator 
dynamics  on  the  control  of  actual  submersibles ,  they  will  be  considered 
as  part  of  the  augmented  plant  dynamics  for  this  design  in  Section  4.1. 
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Figure  2.1.   Conventions  showing  positive  directions  of  deflections,  forces, 
velocities,  and  moments. 
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The  resulting  eight  nonlinear  equations  as  used  in  the  computer 
simulation  with  the  definitions  of  the  hydrodynamic  coefficients  are  given 
in  Appendix  A.   These  coefficients  are  approximated  by  direct  measurement 
on  a  full  scale  or  model  submarine,  or  analytically.   The  accuracy  of 
the  dynamic  response  of  the  model  is  governed  to  a  large  extent  by  the 
accuracy  of  these  hydrodynamic  coefficients.   Additionally,  some  forces 
have  yet  to  be  modeled  mathematically,  and  other  effects  such  as  vortex 
shedding  and  separation  effects  are  not  possible  to  include  in  a  linear 
model  and  are  most  likely  the  weakest  point  in  the  design  model. 

2 . 3    Linear  Modeling 

2.3.1   Equations  of  Motion 

The  controller  design  procedure  begins  with  the  expression  of  the 
equation  of  motion  in  linear  time  invariant  state  space  form.   The  non- 
linear, multivariable  system  that  represents  the  submarine  is  described 
by: 


|-  x(t)   =   f  (x(t)  ,  u(t))  (2-2) 


dt  - 

y(t)   =   g(x(t))  (2-3) 


where 

x  is  the  state  vector 

u  is  the  control  input  vector 
y  is  the  output  vector 


These  nonlinear  equations  can  be  linearized  through  a  Taylor  series  ex- 

d 
pansion  in  the  vicinity  of  a  nominal  point  (ideally  where  —  (x(t)  )  =  0) 

for  small  deviations  of  u(t)  and  x(t)  from  the  nominal  state  u  ,  x  . 

—        —  — o  — o 

From  Eq.  (2-2)  and  (2-3)  the  linearized  dynamics  are  derived  as: 
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Ax(t)    s    AAx(t)     +   BAu(t) 


(2-4) 


Ay(t)    =    CAx(t) 


(2-5) 


where 


Ax(t) 
Au(t) 


x(t)    -   x 
y(t)    -   u 


(2-6) 


and 


f  (x    (t)  ,    u    (t)) 
— o  — o 


x=x 

o 


u=u 
o 


Y    (t) 


g(x   (t)) 
— o 


3f(x,    u) 


A     = 


3x 


x=x 
o 


u=u 
o 


3f(x,    u) 


B      = 


3u 


x=x 


u=u 
o 


C      = 


3g(x) 

3x 


x=x 


(2-7) 


(2-8) 


(2-9) 


20 


The  parametric  linearization  of  the  nonlinear  equations  was  accom- 
plished analytically  in  the  interest  of  accuracy  for  obtaining  good  linear 
models,  given  some  of  the  modeling  drawbacks  already  mentioned.   Details 
are  given  in  Appendix  A. 

2.3.2  Nominal  Point  Selection 

A  most  important  step  in  the  design  process  is  to  select  a  linear 
model  that  best  describes  the  dynamics  of  the  submarine  over  the  widest 
possible  range  of  operating  condtions.   The  control  system  to  be  designed 
in  this  study  will  use  as  command  variables  and,  therefore,  control,  in 
some  manner,  depth  and  heading  rates.   The  nominal  point  chosen  for  the 
design,  then,  will  be  taken  about  a  submarine  in  a  level  turn  (i.e., 
pitch  angle,  or  9  is  zero)  ,  since  this  attitude  of  a  submarine  is  the 
most  likely  operating  condition. 

All  four  actuator  variables;  RPS ,  fir,  fib,  and  gs  must  be  selected 
to  define  the  particular  nominal  operating  point.   The  shaft  RPS  will 
remain  at  that  required  for  30  knots  in  straight  ahead  motion.   The 
rudder  deflection,  fir,  can  be  set  at  arbitrary  angles  to  cause  the  sub- 
marine to  turn  at  different  rates.   A  rudder  deflection  of  (+)  2  degrees 
was  selected  for  this  nominal  point  design.* 

The  next  condition  involves  the  use  of  the  stern  and  bow  planes 
that  result  in  zero  pitch  while  turning.   For  reasons  outlined  in  the 
next  subsection,  the  sail  planes  will  be  "locked"  at  a  zero  deflection 
angle  for  this  model.   With  this  constraint,  the  stern  planes  were  per- 
turbed on  the  nonlinear  conputer  model  in  order  to  achieve  zero  pitch 
angle.   The  four  actuator  variables  chosen  result  in  the  nominal  design 
point  of  Appendix  B. 


* 

The  linearization  about  (-)  2  degrees  of  rudder  would  yield  different 

system  matrices  than  that  obtained  about  (+)  2  degrees  of  rudder;  this 
is  primarily  attributed  to  dynamic  asymmetry  caused  by  rotation  of  the 
vehicle  propellor  (torque  reaction  and  flow) . 
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2.3.3   Output  and  Control  Variable  Formulations 

In  this  subsection  one  will  gain  insight  into  the  appropriate 
selection  of  the  output  and  control  variables  to  accomplish  the  proposed 
control  design.   This  will  eventually  lead  to  the  development,  in  paral- 
lel, of  two  controller  designs  based  on  two  sets  of  output  variables. 
There  will  be  some  freedom  in  the  choice  of  control  (actuator)  variables 
as  well,  but  their  selection  will  be  based  on  a  rather  casual  approach. 

a.   Control  Methodology  Constraints 

The  Loop  Transfer  Recovery  method  for  the  class  of  Model  Based 
Compensators,  apart  from  its  advantages,  places  a  very  important  require- 
ment on  the  design  freedom  at  a  very  early  stage.   It  will  be  seen  in 
later  sections  that  the  mathematics  (singular  values  et  al.)  require  a 
square  system,  that  is,  the  number  of  control  inputs  be  equal  to  the  number 
of  output  controlled  variables.   Stated  more  precisely: 

y(t)   =  £Rm 

u(t)   =   eRP 

where  R  indicates  the  dimension  space  of  the  system.   So  the  requirement 
is 

p  =  m  (2-10) 

and  with  three  independent  control  surfaces  available 

p  <  3 
Note  that  RPS  is  not  a  control  variable  in  the  present  model. 
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b.   Control  Input  Selection 

It  was  proposed  to  have  two  "y"  outputs  for  the  operator  to  con- 
trol through  a  "joystick-like"  device.   From  the  requirement  for  a  square 
system  p  =  m  =  2 .   How ,  then ,  are  the  two  independent  control  inputs 
selected?  Clearly  one  needs  a  rudder  to  produce  motion  in  the  horizontal 
plane.   For  motion  in  the  vertical  plane,  however,  there  are  two  control 
surfaces  available,  the  stern  and  sail  planes,  which  provide  a  redundant 
control  capability.   The  stern  planes  provide  about  three  and  a  half  times 
more  force  to  affect  q  than  the  sail  planes  for  the  same  deflection  angle. 
This  can  be  seen  by  comparing  entries  B(5,  1)  and  B(5,  2)  of  the  B_  matrix 
in  Table  2.2.   Realizing  the  importance  of  controlling  the  stern  planes, 
there  are  two  options  concerning  the  use  of  the  sail  planes: 

(1)  Model  the  submersible  with  the  sail  planes  locked  at  some 

angle,  <5b  /  or; 
o 

(2)  Model  the  submersible  so  that  a  linear  relationship  exists 
between  deflection  of  the  stern  and  sail  planes. 

In  either  method,  there  is  effectively  only  one  independent  control  sur- 
face for  vertical  motion  control. 

Table  2-2.   Model  based  B  matrix. 


State 


6s 


u 

0.29053E-01 

V 

0.00000E+00 

w 

-0.18604E+01 

p 

0.00000E+00 

q 

-0.45053E-01 

T 

0.00000E+00 

$ 

0.00000E+00 

6 

0.00000E+00 

6b 

-0.15339E-02 
0.00000E+00 

-0.13578E+01 
0.00000E+00 
0.13042E-01 
0.00000E+00 
0.00000E+00 
0.00000E+00 


6r 

-0.10  980E+00 
0.21864E+01 

-0.27856E-05 
0.39980E-01 
0.91875E-06 

-0.55462E-01 
0.00000E+00 
0.00000E+00 
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For  Case  2  above,  the  sail  planes  would  be  scheduled  to  be  de- 
flected as: 

6b  =   (-)  k6s  (2-11) 

where  k  is  a  constant  of  proportionality.   If  k  is  positive,  the 
deflection  of  the  sail  planes  will  be  in  an  opposite  sense  to  that  of  the 
stern  planes.   This  would  tend  to  cause  both  control  surfaces  to  act  on 
g,  the  pitch  moment,  in  the  same  direction.   For  non-zero  k,  one  can 
deduce  that  less  deflection  of  the  stern  planes,  6s,  would  be  required 
to  produce  a  given  moment  q.   Since  there  is  a  limit  on  the  plane  cycle 
rates  of  about  6  degrees  per  second,  it  would  appear  that  have  a  non-zero 
k  could  reduce  the  time  lag  over  a  system  with  constant  6b  for  a  required 

q- 

The  revised  B  matrix,  B* ,  in  going  from  three  to  two  independent 
control  inputs  according  to  (2-11)  is 

B*(i,  1)   =  B(i,  1)  -  k   B(i,  2) 

B*(i,  2)   =   B(i,  3)  (2-12) 

where  i  =  1  to  8 

B(i,  1)   =   stern  plane  control  vector 
B(i,  2)   =   sail  plane  control  vector 


and 


B(i,  3)   =  rudder  control  vector 
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In  the  first  option  above,  a  constant  deflection  other  than  6b  =  0 
may  not  prove  to  be  ideal  if  the  controller  is  to  operate  at  arbritrary 
pitch  conditions  in  a  turn.   Additionally,  if  several  nominal  points  were 
selected  for  gain  scheduling,  then,  when  the  controller  shifted  from  one 
set  of  gains  to  another,  a  step  change  in  6b  may  be  required.   This  change 
could  lead  to  other  problems  and  possible  instabilities. 

In  this  design,  k  has  consequently  been  chosen  to  equal  zero  so 
that  6b  =  0.   This  is  consistent  with  current  fleet  submarine  practice  of 
generally  not  using  the  sail  planes  to  accomplish  high-speed  maneuvers. 
The  effect  of  k  on  robustness  and  performance  will  not  be  addressed  in 
this  thesis. 

c.   Output  Variable  Selection 

Ideally  one  would  have  the  present  systems  directly  control  the 
bearing  rate,  ty ,    and  depth  rate  z.   The  expressions: 

i|i      =       (r   cos   <f>   +  q   sin    9) /cos   0  (2-13) 


and 


z   =  -u  sin  0  +  v  cos  8  sin  $  +  w  cos  9  cos  $       (2-14) 

are  nonlinear  functions  of  the  state  variables. 

To  proceed  further,  the  open- loop  time  domain  linear  model  of  the 
plant  in  Figure  2-2  is  introduced.   Here  the  output  variable,  y(t) ,  is 
defined  as  y (t)  =  Cx(t) .   The  C  matrix  will  be  an  important  parameter  in 
the  design  of  the  Model  Based  Compensator.   The  C  matrix  is  a  constant 
matrix  which  represents  the  linearization  of  (2-13)  and  (2-14)  using  (2-9) 
Letting  y  =  $  and  y  =  z,  the  coefficients  of  the  C  matrix  are  given  in 
Table  2-3.   The  matrix  indices  (1,  2,  ...,  8)  represent  states  u,  v,  w,  p, 
q/  r,  $,  9,  respectively,  the  subscript  "o"  indicating  the  (value  of  the) 
state  at  the  nominal  point. 
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U(t) 


+  ,1 


"^     X(t) 

f 

X(t) 

c 

Y(t) 

J 

A 

Figure  2-2.   Linear  open- loop  plant  model. 


Table  2-3.   Linearization  of  outputs  tJj  and  z  to  obtain  the  C  matrix. 


sin 


C(l,  5)   = 


cos 


COS 


C(l,  6)   = 


cos 


C(l,  7)   = 


-r   sin  d>   +  q  cos  0 
o _o o o 

cos  9 


C(l,  8)   = 


(r   cos  d>   +  q  cos  d>  )  +  tan  6 
o o    o _o o 

cos  9 


C(2,  1) 

C(2,  2) 

C(2,  3) 

C(2,  7) 

C(2,  8) 


=  -  sin 


cos  9   sin  <j> 
o      o 


cos  *   cos  t) 
o      o 


v   cos  0   cos  q>   -  w   cos  0   sin  tp 
o      o      o    o      o      o 


-u  cos  0   -  v   sin  0   sin  tp   -  w   sin  0   cos  cp 
o      oo      o      oo      o      o 
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To  determine  how  accurately  y(t)  =  Cx(t)  represents  the  actual  ob- 
served  outputs  ip   and  z,  the  author  has  taken  all  states  of  a  maneuver  of 
a  submarine  in  a  turn  and  reconstructed  the  linear  and  nonlinear  (actual) 
representations  of  \p  (t)  and  z  (t)  .   These  results  are  presented  in  Fig- 

•  ■ 

ures  2-3  and  2-4.   It  is  seen  that  z,  .      becomes  50%  of  z         It 

linear  actual 

is  found  that  the  relative  deviation  between  the  linear  and  actual  z 

•  *  • 

decreases     as    z  ,    increases    in  magnitude,      y  ,    and  it  are 

actual  actual  linear 

nearly   identical   over   the    full  maneuver.      The   control  design  based  on 
these    linearized   states  will  be   referred   to   in  the   remainder   of   this 
study  as   the  t/j    —    z   controller. 

An   alternative   to   a  C  matrix  which  is   dependent  on   the   vehicle 
states   at   the   nominal  point   is   to   choose   C   such  that   its  entries   are 
independent   constants,    but   that  would   still  represent  rates   that   are 
desirable   to  control. 

Referring   to  Figure   2-4   once  more   one   can   see   that   such  a  term 
for  i|i   exists.      The    state   r   has,    throughout   this  maneuver,    remained  within 
4%   of  i[i  .      This   is  made   clear   by  referring  to    (2-13)    and  noting 

dCtUcll 

that  for  nearly  all  turning  maneuvers,  r  >>  q  and  the  cos  9=1.   To 
control  depth  rate,  one  can  revert  back  to  current  submersible  opera- 
tional practice  of  commanding  pitch  angle.   This  follows  from  (2-14) 
where  u  >>  v,  w  so  that  z  =  -u  •  sin  9  =  -u9 .   Since  forward  velocity  is 
known,  z  is  proportional  to  9  so  C  becomes: 

C(l,  6)   =   1 
C(l,  8)   =  1 

The  designed  based  on  this  C  matrix  will  be  known  as  the  r  -  9  controller. 

•  • 

For  implementation  purposes  the  exact  values  of  \p   and  z  are  always 
available  (observable)  for  both  the  nonlinear  models  and  the  actual  submer- 
sible.  Observer  devices  to  measure  z  include  depth  gauge  measurement.   For 
more  accurate  designs  with  less  environmental  noise,  gimballed  accelerom- 
eters  could  be  integrated  to  provide  z.   The  installed  rate  gyros  used 
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Figure    2-3.      Reconstruction  of   actual   and   linearized  depth  rate    for 
the    submarine    in   a   turn. 
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Figure  2.4.   Reconstruction  of  actual  and  linearized  turn  rate,  and  the 
state  "r"  for  the  submarine  in  a  turn. 
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for   fire   control    system  can  measure   the    submarine's   true   heading  rate,    ty , 
regardless  of  the   vehicle   attitude.      The   r   and  9    states   can  be  measured 
with  similar  ease. 

2.4    Dynamic  Analysis 

In  this  subsection  the  open-loop  poles  (eigenvalues)  and  eigen- 
vectors will  be  calculated,  and  the  conditions  for  controllability  and 
observability  of  linear  control   systems  will  be  presented. 

The  eigenvalues  of  the  A  matrix  resulting   from  the   linearization 
are    shown   in  Table    2-4.      The   corresponding  normalized  eigenvectors   are 
shown   in  Figure    2-5.      It  would   appear   that   all  modes   are   dominated  by 
the   velocity   states   u,    v,    and  w.      A  different  picture   results  when   the 
values   of   the   eigenvectors   involving  angle   and   angle   rate    states   are 
scaled   from  radians   to   degrees   and  the  velocities   u,    v,    and  w  remain 
in   feet/second.      Although  the   choice   of   units  was   somewhat   arbitrary, 
the    scaled   and  normalized  eigenvectors  of  Figure    2-6   seem  to  provide    a 
clearer  picture   of   the    state   contribution  to   the    system  modes.      The   com- 
plex pole,    -0.19  ±    0.32i,    is   associated  with  the   natural   roll  behavior   of 
the    submarine.      The    slowest  pole,    -0.013,    is  primarily   a  pitch  mode.      The 
zeroes  of   the    system  will  be   discussed   in  Chapter   4,    after   the   addition  of 
augmented  dynamics. 

Table    2-4.      Complex  eigenvalues   of  A. 

-0.190874E+00  0.320975    I 

-0.190874E+00  -0.320975    I 

-0.487435E+00  0.000000    I 

-0.443184E+00  0.000000    I 

-0.978560E-01  0.000000    I 

-0.432890E-01  0.000000    I 

-0.591569E-01  0.000000    I 

-0.133116E-01  0.000000    I 
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Figure    2-5.      Unsealed  eigenvectors  of    [A] 
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Figure    2-6.      Sclaed  eigenvectors  of    [A] 
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Controllability  and  observability  properties  need  to  be  established 
to  proceed  further  with  the  control  system  design.   Controlability  is  en- 
sured only  if  the  matrix 


[B,  AB,  .  .  .  ,  A   B] 


(2-15) 


has  rank  n.   Similarly,  observability  is  guaranteed  if  the  matrix 


C 

CA 


CA 


n-1 


(2-16) 


has  rank  n. 

A  simpler,  but  more  conservative  method  than  (2-15)  and  (2-16) 
above  will  be  used  to  establish  controllability  and  observability.   Since 
eigenvalues  of  A  are  distinct  and  nonzero,  one  can  find  the  complex  modal 
matrix,  T,  whose  columns  are  the  distinct  eigenvectors,  v..   For  any  set 

of  scalars  c.  (not  all  zero): 

l 

Z  C.v   =   0 
l 

l 

implies  that  T  is  a  nonsingular  matrix.   Then  the  state  equation  can  be 
written  in  the  modal  domain  [5] : 


d   * 


T   ATx*  +  T   Bu 


y   =   C  T  x* 
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The  controllability  and  observability  conditions  are  then  more  than 
satisfied  by  observing  that  the  real  parts  of  the  columns  of  T  B  and 
the  rows  CT  have  no  zeros.   This  was  found  to  be  the  case  for  both  the 
r  -  9  and  z  -  \p    systems. 


2 .5    Performance  Specifications 

Performance  specifications  outlined  in  this  section  are  not  all 
encompassing  and  may  not  coincide  with  established  Navy  specifications 
for  submersible  control.   The  performance  requirements  as  stated  here 
are  mainly  driven  by  the  intuitive  engineering  approach  to  obtain  good 
command  following,  speed  of  response,  robustness,  and  disturbance  re- 
jection with  due  respect  to  the  natural  dynamics  of  the  vehicle  as 
they  emerge  from  the  available  model.   These  performance  requirements 
(guidelines)  will  be  accomplished  through  loopshaping  techniques  to  be 
discussed  in  Chapter  3. 

Since  there  are  no  natural  integrator  states  (the  8  x  8  A  matrix 
is  nonsingular) ,  elimination  of  steady-state  error  to  step  inputs  is  not 
possible.   Good  command  following  and  elimination  of  steady-state  errors 
will  be  obtained  through  the  use  of  integrators  in  the  command  variable 
channel.   Although  an  actual  rate  control  system  may  also  experience 
ramp-like  commands  from  the  "joy-stick",  the  command  inputs  here  are 
closer  to  being  a  step  due  to  the  large  time  constants  of  the  system. 
Therefore,  the  system  described  in  this  thesis  will  not  be  designed  to 
meet  type-2  specifications. 

The  open- loop  dynamic  simulation  demonstrates  that  achievable 
vehicle  settling  times  due  to  deflections  of  control  surfaces  are  a 
function  of  the  vehicle  speed.   For  a  submersible  at  a  speed  of  30  knots, 
settling  time  of  50  -  60  seconds  are  achievable.   When  settling  is  de- 
fined to  occur  in  4  or  5  time  constants,  the  resulting  minimum  band- 
width requirements  for  crossover  are  0.07  to  0.1  radians/second.   From 
the  performance  aspect  it  is  desirable  to  have  all  channels  crossover 
at  roughly  the  same  frequency. 
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On  the  high  frequency  side,  one  must  be  able  to  reject  noise  and 
possible  modeling  errors.   Noise  sources  generally  originate  from  the 
environment  (true  sensor  readings)  or  from  the  sensor  itself.   Sensor 
noise  typically  comes  at  a  higher  frequency  than  the  system  bandwidth  and 
should  not  affect  ship  dynamics  since  ship  eigenvalues  will  typically  lie 
in  the  lower  frequency  band.   It  is  desired  that  the  ship  actuators  do 
not  respond  to  normal  environmental  disturbances  that  may  cause  unnces- 
sary  actuator  motion.   Of  concern  here  is  the  effect  of  the  submersible 
operating  close  to  the  surface ,  but  not  so  close  as  to  be  in  the  danger 
of  broaching,  and  experiencing  excitations  of  surface  waves.   Based  on 
Figure  2-7  [6] ,  it  is  apparent  that  a  typical  wave  spectrum  has  a  fre- 
quency range  between  0.2  and  2  radians/second.   The  excitation  or  driving 
frequency  the  submarine  experiences  will  be 


to   =  to  +  ku  cos  ($) 
e 


where 


to   =  frequency  of  encounter 
e 

u   =  wave  spectrum  frequency 

2 
k  =  to  /g  =  wave  number  in  deep  water 

u  =   ship  forward  velocity 

$   =  ship  head  relative  to  sea  direction 

then,  based  on  an  estimated  max  ship  speed  of  35  knots  (60  fps) 


co  max  =   9.5  rad/s  (in  head  seas) 
e 


to  min  =  0.13  rad/s  (in  following  seas) 

e 


35 


0.2  0.4  0.6  0.8 


(rad/sec) 


Figure    2-7.      Typical   form  of   a  wave    spectrum 
containing   swell    (from  Ref .     [6] ) 


and  therefore   at   any  vehicle    speed,    35   knots  or    less,    all  other   ship 

headings   relative   to  the    sea  will  be   contained  within  co  max  >   oj      >   oj  min. 

e       e    e 

The  proposed  controller  will,  then,  be  able  to  meet  these  minimum 

criteria  with  the  suggested  bandwidth,  at  least  in  the  region  where  linear 

behavior  dominates  the  vehicle  dynamics. 
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CHAPTER  3 


CONTROL  SYSTEM  DESIGN  METHODOLOGY 


3. 1    Robustness 

3.1.1  Robustness  Design  Considerations 

Control  system  design  frequently  involves  the  tradeoff  of  realizing 
high  performance  while  preserving  good  command  following,  disturbance 
rejection,  and  system  stability.   The  achievement  of  high  performance  is 
pointless  if  the  control  system  becomes  unstable  as  a  result.   This  is 
particularly  important  in  the  present  design.   Overall  system  instability 
could  cause  the  submersible,  in  some  instances,  to  exceed  its  safe  operating 
depth  or  ground  itself,  resulting  in  the  loss  of  the  submarine  and  its  crew. 
The  multivariable  methods  used  to  assure  stability  and  robustness  will  be 
reviewed  next. 

Singular  value  analysis  has  evolved  as  a  reliable  method  to  evaluate 
system  stability  and  robustness  in  the  presence  of  unstructured  uncertainty. 
The  singular  values  of  an  (n  x  n)  complex  matrix  A  derived  from  the  spectral 
norm  | | a| |   are  defined  by: 


a .   =  "sT 


where 


X  .  (A  A)      i  =  1 ,  2  ,  .  .  .  ,  n 
l 


A   is  the  complex  conjugate  transpose  of  A 


X.  is  the  ith  eigenvalue  operator 


37 


and  represents  a  measure  of  how  close  the  matrix  A  is  to  being  singular. 
A  plot  of  the  singular  values  of  a  multivariable  transfer  matrix  could  be 
interpreted  in  an  analogous  manner  to  the  single  input — single  output  Bode 
plots. 

The  properties  of  singular  values  will  now  be  applied  to  obtain 
statement  of  guaranteed  stability.   Let  Figure  3-1  represent  the  MIMO 
feedback  configuration,  where  G(s)  is  the  true  plant  transfer  function  at 
all  points.   Figure  3-2  represents  the  same  system  except  now  G(s)  = 
G(s)L(s)  ,  so  that  L(s)  represents  a  perturbation  of  the  nominal  system 
G(s).   It  is  desirable,  then,  to  determine  under  what  conditions  of  L(s) 
the  nominal  system  will  remain  stable. 


r(t) 


^ 

K(s) 

G(s) 

y(t) 

J 

\ 

Figure  3-1.   MIMO  feedback  configuration. 


L(t) 


■>, 

Ms) 

G(s) 

L(s) 

y(t) 

) 

1 

Figure  3-2.   MIMO  feedback  configuration  representing 
perturbation  of  the  nominal  system. 


There  are  many  ways  to  represent  L(s) .   To  characterize  the  robust- 
ness of  the  system,  Lehtomaki  [7]  utilizes  matrix  transfer  functions  located 
at  various  points  in  the  plant.   He  defines  addition,  multiplication, 
division,  and  subtraction  errors.   Multiplicative  error  has  the  property 
of  preserving  relative  quantities  and  is  independent  of  the  units  used 
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in  modeling  the  system  dynamics  and  therefore  will  be  used  in  this  model. 
Furthermore,  a  premultiplicative  error  of  the  loop  transfer  function  will 
be  defined  to  reflect  errors  at  the  plant  output,  as  shown  in  Figure  3-3. 
In  this  instance 


L(s)   =  I  +  E(s) 


so  that  the  premultiplicative  error,  E    (s) ,  is  found  to  be 

—pre 


E    (s)   =   [G(s)  -  G(s)]G_1(s) 
—pre         —      — 


(3-1) 


£(t) 


E(s) 

' 

~^ 

K(s) 

G(s) 

J 

I 

y(t) 


Figure  3-3.   MIMO  feedback  configuration  reflecting 
premultiplicative  error  at  plant  output. 


From  the  Fundamental  Robustness  Theorem  and  the  Theorem  for  Robust' 
ness  for  Multiplicative  Errors  (see  Lehtomaki  [7]),  for  guaranteed  stabil- 
ity, the  following  inequality  must  hold: 


a    [E    (jw)  ]  <  a  .  [I  +  (G(JLo)K(joo)  )"  ] 
max  — preXJ    —  min  —    —  J   — 


(3-2) 
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If  the  inequality  (3-2)  above  is  not  true,  it  does  not  necessarily 
imply  the  system  must  be  unstable.   Singular  value  analysis  does  not  take 
into  account  the  actual  direction  of  the  perturbation  matrix  that  may 
cause  a  system  to  become  singular;  hence  the  system  may  actually  be  more 
robust  than  singular  value  analysis  may  indicate.   Therefore  the  inequality 
(3-2)  above  is  conservative. 

3.1.2   Scaling 

Scaling  is  a  method  of  weighting  the  physical  units  of  a  system, 
through  an  appropriate  transformation,  so  that  the  numerical  values  of 
the  variables  become  equally  significant.   Scaling  and  its  effect  in 
designing  robust  multivariable  control  systems  has  been  resently  dis- 
cussed by  Kappos  [9]  and  Boettcher  [8] .   Apparently,  scaling  does  in 
fact  change  the  singular  value  magnitudes,  but  it  may  not  necessarily 
change  the  robustness  of  the  system  [8],   Ostensibly,  not  all  effects  of 
scaling  are  understood  at  present. 

A  systematic  method  does  not  yet  exist  to  obtain  optimal  scaling. 
Kappos  [9]  selects  a  scaling  matrix  based  on  the  expected  nominal  departure 
(error)  of  the  output.   Kwakernaack  [10] ,  although  not  specifically  addres- 
sing the  robustness  issue,  similarly  suggests  weighting  the  states  by 
their  tolerable  error,  i.e.,  a  deviation  of  10  ft/s  in  velocity  may  be 
as  bad  as  a  deviation  of  0.2  radians  in  pitch,  and  then  base  the  weighting 
on  the  ratio  of  the  tolerable  errors.   In  this  thesis  the  author  presents 
a  method  that  allows  the  system  to  scale  itself  through  loop  shaping 
techniques.   This  procedure  will  be  presented  in  Chapter  4. 

A  scaling  transformation  to  transform  state  vectors  must  be  diagonal 
and  positive  to  preserve  the  system  eigenvalues.   Briefly,  if  u,  y,  and  x 
are  the  original  state  vectors,  and  u1 ,  y' ,  and  x'  are  a  set  of  scaled 
vectors,  then: 
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u  =   S  u1 


y   =   S  y' 


x   =   S  x'  (3-3) 

—     — x— 


consequently  for  a  system  of  the  original  form: 


x  =  Ax  +  Bu 


y  =  Cx  (3-4) 


the  transformed  matrices  become 


A*  =  S~   A  S 

—  —x X 

B'  =   S~   C  S 

—  —x y 

C  =  S-1  C  S  (3-5) 

—  -y x 

Scaling  directly  affects  transfer    functions   as  well.      Defining  the 

open-loop   transfer    function,    G  (s)    of  Figure    2-2   as 

GqL(s)  =     C(sl-A)_1B  (3-6) 

it  can  be  shown  straightforwardly  that  the  scaled  transfer  function  be- 
comes 

G'  (s)  =  S-1  G(s)S  (3-7) 

-         -y  -   -u 


4] 


Similarly,  scaling  E    (s)  ,  the  premultiplicative  error  defined  in  Eq.  (3-1)  , 
one  obtains 

E'  (s)   =  S_1  E(s)S  (3-8) 

-       -y  —  -y 


Finally,  a  useful  property  of  the  scaling  transformation  will  be 
ed  next.   Take  tl 
identity  matrix  so  that 


developed  next.   Take  the  special  case  of  Eq.  (3-7)  where  S    is  the 

^u 


G'  (s)   =   S  -1   G(s)  (3-9) 

-       -y    - 


By  taking  the  complex  conjugate  transpose  of  Eq.  (3-9)  above: 


G,H(s)   =  GH(s)  S"1H  (3-10) 

—  —       -y 


From  Eq.  (3-9)  and  (3-10)  then 


G'  (s)G'H(s)   =   S_1  G(s)GH(s)S_lH  (3-11) 


and,    applying  the   two-norm  implies 


|G'(S)||2      =      ||S^1G(S)||^  (3-12) 


so  that 


|G'(s)||2      =       ||s_1G(s)||2  (3-13) 
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Note  that  S    is  not  a  function  of  s.   Through  matrix  multiplication, 
"^      -1      -l  -1 

the  diagonal  entries  of  S    —  S   of  the  matrix  S    independently  multiply 

the  rows  of  G(s).   Knowing  the  following  relation  to  hold 


aA 


where  a  is  a  scalar , 

it  follows  that  the  i  singular  values  of   Is   G(s)|   satisfy 

l_y       _  ii 

a.  [G1  (s)]       =      S_1   a.  [G(s)]  (3-14) 

l  —  ii  — 

Hence,    it   is    seen  that   the   transformation  matrix  S    ""   directly  effects   the 

Y 
magnitude   of   the    singular   values   of   the   original   transfer  matrix.      Equation 

(3-14)    will  be   an   important   tool   that  will   be   employed   in  Chapter   4   to  help 

select   appropriate    scaling  transformations   to   achieve   consistent   loop 

shaping. 


3.2    LQG  Compensator 

The  Model  Based  Compensator  (MBC)  has  evolved  from  the  optimal  esti- 
mation theory  (Kalman  Filter)  and  optimal  control  theory  (Linear -Quadratic 
Feedback) .   The  concepts  presented  here  can  be  found  in  more  complete  form 
in  references  [10]  and  [11] .   The  form  of  the  compensator  used  in  this 
design  together  with  the  state  definitions  is  shown  in  Figure  3-4  with 
the  plant  and  compensator  dynamics  represented  separately.   The  transfer 
function  definitions  used  in  the  remainder  of  this  paper  will  be  based  on 
Figure  3-4. 

Referring  to  Figure  3-4,  the  error  e_(t)  is  the  input  and  u(t)  is 
the  output  of  the  compensator;  the  overall  MBC  transfer  matrix  is  defined 
by 

u(s)   =  K(s)  e(s) 
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where 


K(s)   =   G(sl  -  A  +  BG  +  HC)    H  (3-15) 


Also,  it  is  easily  shown  that  the  overall  closed- loop  transfer  function, 
*CL(S)  iS 

J>   (s)   =  det(sl  -  A  +  BG)   det(sl  -  A  +  HC)      (3-16) 
It  follows  that  the  requirements  for  stability  of  the  system  are: 


Re  A. [A  -  BG]  <  0  (3-17) 


and 


Re  A. [A  -  HC]  <  0  (3-18) 


which  are  the  poles  of  the  compensator. 

The  conditions  for  ensuring  a  stable  compensator  are  now  postulated. 
From  linear  system  theory,  if  the  pair  [A,  B]  is  controllable  (or  stabiliz- 
able) ,  then  there  exists  at  least  one  feedback  gain  matrix  G  to  ensure  that 
all  closed-loop  poles  of  [A  -  BG]  are  in  the  left  half  s-plane.   G  is 
given  by 

G   =  R-1  BK  (3-19) 

where  K  solves  the  Control  Algebraic  Ricatti  Equation  (CARE) : 

0   =   -KA  -  ATK  -  Q    +   KBR~  B  K  (3-20) 
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Likewise,  if  the  pair  [A,  C]  is  controllable  (or  detectable) ,  then 
there  exists  at  least  one  output  gain  matrix  H  such  that  all  closed- loop 
poles  are  in  the  left  half  s-plane.   The  matrix  H  is  given  by: 

T  -1 
H  =  z   C  H  (3-21) 

where  Z_  solves  the  Filter  Algebraic  Ricatti  Equation  (FARE)  : 

0   =   ZA  +  ATE  +  LHL  -  ECTe~  CI  (3-22) 


3. 3    Loop-Transfer  Recovery 

In  the  sequel,  some  properties  of  the  Kalman  Filter  that  forms 

the  basis  for  the  Loop-Transfer  Recovery  (LTR)  method  to  be  employed  in 

this  design  will  be  discussed.   The  Kalman  Filter  loop  transfer  function, 

G   ,  is  taken  at  point  1  on  Figure  3-4.   The  resulting  loop-transfer  func- 
— KF 

tion  is  defined 

G  „   =   C(sl  -  A)"1  H  (3-23) 

— KF      —  —   —    — 

One  can  also  define  G    /  the  filter  open- loop  transfer  function  as 

G^T   -   C(sl  -  A)"1  L  (3-24) 

F  (JL 

where  L  is  a  free  design  parameter  that  is  chosen  to  give  G    desirable 
—  — FOL 

singular  values  to  meet  the  performance  and  robustness  specifications. 
The  Kalman  Filter  Domain  Equality 

[I  +£kF(3)][^  +  ^KF(S)]H   =   I  +  ^FOL(S)  ^FOL(S)       (3"25) 

has  been  derived  from  Eq.  (3-22) ,  (3-23) ,  and  (3-24)  where  the  substitu- 
tion 
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=      \il  for   y    >  0 


has  been  made    in  the   FARE  Eq.     (3-22) 
As 


y  -*  0 


in  Eq.  (3-25)  ,  it  follows  directly  from  the  definition  of  singular  values 
that 


a.[GKF(jaJ)]  B  a.[^GF0L(jU)]  (3-26) 


which   is  valid   for   low   frequency  range,    and  represents   the   recovery  of   the 

loop    shapes  of   the   G        from  G        .      The   value   of   \i    is   also   a   free-design 

— KF  — FOL 

parameter. 

The   Kwakernaack  Loop  Transfer   Recovery  process    (see   e.g.,    Doyle, 
Stein    [1],    Kwakernaack    [12])    is   described  next,    in  which  the    shapes   of 
the   Kalman  Filter    singular   values  of  Eq.     (3-26)    are   recovered   in  the    loop- 
transfer  matrix  of   the  Model  Based  Compensator.      The    loop- transfer  matrix 
of  Figure    3-4   is   given  by 


T      =      G(s)    K(s)       =      C(sl    -   A)~      BG(sI    -   A   +   BG   +   HC)         H 


(3-27) 


The  LTR  method  sets 


R   =   I 


and 


T 
Q   =   qC  C 
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in  the  CARE  Eq.  (3-20).   Then,  as 


the  corresponding  G^  in  Eq.  (3-27)  becomes  'large'  so  that  Eq.  (3-27) 
becomes 


T  =  C(sl  -  A)"   H  (3-28) 


and,    consequently 

a.  [T    (jw)]    •+  a.  [C(jwl   -  A)"1   H]  (3-29) 

1  °°  1 

for  low  frequencies. 

The   LTR  method   is   guaranteed  to  work   in  the   open- loop   system   is 
minimum  phase .      For   non-minimum  phase    systems   there    is  no   such  guarantee , 
although   some   recovery  of  performance   and  robustness  properties   are 
expected  as   the   non-minimum  phase    zeros  move    further   away   from  the   desired 
operating  bandwidth    (see    [13]). 

Robustness  Theorems 

The    following  robustness  properties   can  be   derived   from  the   Kalman 
Filter  Equality    (3-25)    and  are   required   for    system  robustness: 

(1)         a    .     [I   +  Gfjoj)]     ■    1  (3-30) 

min  —       — KF    J  — 

which   follows   directly   from  the   KFE;    and 

(2>     Wi^^ii  <3-31' 

which  has  been  proved  by  Kappos  [9] . 
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CHAPTER  4 


COMPENSATOR  DESIGN  PROCEDURE 


4.1    Augmented  Dynamics 

Augmenting  the  dynamics  of  the  submersible  control  system  serves  a 
dual  purpose.   One  is  to  model  the  actuator  dynamics  to  make  the  model  as 
accurate  as  possible,  and  achieve  desirable  roll-off  at  crossover  for 
robustness.   The  other  is  to  include  integrators  to  cause  the  compensator 
to  behave  as  a  type-1  system,  which  will  permit  the  submersible  to  achieve 
zero  steady-state  error  to  step  inputs  and  disturbances  (i.e.,  good  command 
following) .   The  result  will  be  to  increase  the  order  of  the  sytem  by  four 
in  the  present  two- input  design. 

A  block  diagram  of  the  augmented  model  appears  in  Figure  4-1.   It 
is  seen  that  the  augmented  dynamics  have  been  placed  in  the  command  channel, 
u  is  the  true  commanded  input  (a  physical  variable),  u    ,  the  output  of 

"~ ~C  3.CC 

the  augmented  dynamics,  is  not.   The  mathematics  of  the  augmented  states 

will  be  manipulated  in  such  a  way  as  to  provide  a  means  to  achieve  the 

desired  loop  shapes  of  G    . 

FOL 

Actuator  Dynamics 

The   complete   actuator   dynamics   are   governed  by   their  mass  proper- 
ties of   the   rudder   and  planes,    and   angle   rate    limits   imposed  by   the 
electro-hydraulic    servomechanisms   that  position  them.      Since   the   rate 
limits   are   highly  nonlinear,    they  will  not  be  modeled  per    se .      Instead, 
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Figure  4-1.   Augmented  dynamics  placed  in  command  variable 
channel  of  plant. 


the  compensator  will  be  designed  so  that  the  rudder  and  stern  planes  are 
never  driven  past  their  rate  limits  of  7  and  6  degrees /second  respectively, 
nor  past  their  maximum  allowable  deflection  angle. 

The  actuator  dynamics  of  the  rudder  are  represented  by  a  second- 
order  system.   These  are  given  for  the  stern  planes  as 


uj,   =  1.37 
a 


C   =   0.9 


and  for  the  rudder  as 


a).   =   1.09 
d 


5   =   0.9 


as   Z,   approaches   unity,    a   second-order   system  begins   to    lose   its  oscillatory 
characteristics   and  behavior   tends   toward  a   first-order   system.      Since   this 
is  very  nearly   an   overdamped   system,    the   actuators  will  be  modeled  as   a 
first-order    system.      By  Ogata    [15]    the   rise   time    for   a   second-order    system 
is   given  by 
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tt  -   tan 


-l     A  -  c' 


so  that   for   the    stern  planes 


and   for   the   rudder 


t    =   1.96  s 
r 


t   =  2.47  s 
r 


Equating  the  rise  time  to  4  time  constants  in  an  equivalent  first-order 
system,  then 


and 


tc    =  0.49  s 

6s 


t„    =  0.62  s 

or 


The   augmented  actuator   dynamics,    with  integrators,    are  presented   in 
Figures   4-2   and   4-3.      The    full    state    space   representation  of   the   dynamics   are: 


r-      l 


(xa)      = 


and 


T 


5s 
0 


5r 


•6s 
0 


6r 
0 

0 


{x    }    + 
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0  0 
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10        0        0 
0         10        0 


(x    } 
—a 


C   x 

—a— a 
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Figure  4-2.   Stern  plane  command  channel  with 
augmented  dynamics. 


Figure  4-3.   Rudder  command  channel  with 
augmented  dynamics. 


These  dynamics  are  introduced  to  the  8th  order  state  space  repre- 
sentation to  produce  a  12th  order  system.   To  get  it  in  a  form  for  further 
design  manipulation  a  new  state  vector  is  defined 


x  = 


x' 


X 

— s 


where  x1  is  the  unaugmented  8th  order  system  augmented  with  the  two  command 

channel  actuator  time  lag  states  and  x  are  the  two  integrator  states  in 

— s 

the  command  channel.   The  augmented  system  can  be  written  as 
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- s 


-8x8 


s8 


1 

6s 

0 

1 

T6s 

0 

0 

0 

1 
V 

0 

1 

V 

0 

0 

0 

x' 


X' 

— s 


_  _  _  _  u 


y  = 


^8 


x' 


and  simplifying  let 


x' 

— s 


- ■ 

"-1 

A,„ 

B 

-10 

T 

_  0 

0 

— ■  \  — s 


u  =  Ax  +  Bu 


Y   = 


[' 


-10  i 


x' 


=   Cx 


(4-2) 


This  form  of  state  space  equations  will  be  used  in  Section  4.2  to  derive 
suitable  loop-shaping  algorithms.  The  A  and  B_  matrices  of  the  augmented 
system  are  found  in  Appendix  B. 

Augmented  System  Dynamics 

The  four  additional  states  add  two  poles  at  the  origin  and  one  each 
at  -1.6  and  -2.0  to  those  already  listed  in  Table  2-4.   The  multivariable 
zeros  for  both  the  r  -  6  and  4>    -   z   system  are  listed  in  Table  4-1.   Note 
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:r:\  ^::0  plant  2  :?  r-thiir 


ic" 


Figure  4-4.   Unaugmented  open-loop  plant;  r  -  0  system; 
singular  values  vs  frequency. 
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OPEN  LOOP  PLANT  2X8    »* 


10  _IC_  10  10" 

FREQUENCE    [RRD/SEC1 

Figure    4-5.      Unaugmented  open- loop  plant;    1J1   -   z   system; 
singular   values  vs   frequency. 
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DPEN  LOOP  PLRNT  2X12  R,  THETR  UNSCRLEQ 


10"  10" 
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Figure  4-6.   Augmented  open- loop  plant;  r  -  9  system; 
singular  values  vs  frequency. 
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Table   4-1.      Augmented   system   zeros    (finite) 


r   -    9   System  Zeros; 


»*JMBER  REAL  IMAG  DAMPING  FREQUENCY 

1  -3.796252290E-02 

2  -1.570S45617E-01 
5        -2.907626130E-01 

5        -1.882000042E-01  -3.0fcO<+23035E-01     5. 2582745  95E-01     3.59278fc288E-01 


\\>   -   z   System   Zeros 


NlfrSER  REAL  IMAG  DAMPIMG  FREQUENCY 

1  -3.796476182E-02 

2  -2.387798847E-01 

3  -3.115217184E-01 

5  -1.815410260E-01  -I. 0882406 98E -01   5.063557471E-01   3.581296886E-01 

6  7.20945S317E-01 


that  ty   -   z   system  has   a  non-minimum  phase   zero   at  0.7,    the   existence   of 
which   is  most   likely  due   to   the   relationship   between   the  pitch    (9)    and 
heave    (w)    states    in   z.      It   is  pointed  out  here    that  both  the   actuator 
dynamics   and   the   non-minimum  phase    zero   are   beyond  the   desired   system 
bandwidth  of   0.1.      Therefore,    they  are   not  expected  to  effect   the   design 
appreciably.      However,    the   actuators   have   been   incorporated   in  the   design, 
to  provide   additional   roll-off   at   higher    frequencies. 

Open-Loop  Transfer   Function 

The    singular   values  of   the   unaugmented    (8th  order)    G        systems   are 
plotted   in  Figure    4-4   and   4-5.      In  both  of   these    figures,    the  minimum 
singular  values   correspond  primarily   to   the   turn  related  outputs,   ty    and  r. 
The   beginning  of  gain  roll-off   corresponds   to   a   system  pole   as   it  would 

in   a  Bode  plot.      The  maximum   singular   values   in  both   figures  begin   to 

-2 
roll-off  at   10    '   radians/s,    which  corresponds   to   the  pole   at  -0.013 
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OPEN  LOOP  PLANT  2X12  ZDOT,  PSIDOT  UNSCRLED 


10 


:ncy  ^pg/sel 


Figure    4-7.      Augmented  open- loop  plant;    \\i   -   z   system; 
singular   values  vs    frequency. 
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(the  6  -  w  dominated  eigenvector  of  Figure  2-6) .   The  minimum  singular 
values  start  to  roll-off  at  10  "  radians/s,  which  relates  to  the  pole  at 
-0.097.   This  pole  corresponds  to  the  "slowest"  eigenvector  to  first  con- 
tain components  of  the  r  state.   The  bandwidth  corresponding  to  the  r  and 
ty   outputs  is  nearly  an  order  of  magnitude  greater  than  the  z  and  6  outputs. 

The  open-loop  singular  values  of  the  augmented  (12th  order)  system 
are  shown  in  Figure  4-6  and  4-7.   The  integrators  in  the  command  channel 
correspond  to  the  slope  of  1/s  or  20  dB/decade  at  low  frequency.   Also  note 
that  the  minimum  singular  values  of  both  figures  are  nearly  identical  over 
the  chosen  frequency  range.   It  will  be  shown  that  either  choice  of  r  or  ^ 
as  an  output  variable  will  result  in  nearly  equal  performance  in  the  con- 
troller design. 

4.2    Loop-Shaping  Techniques 

In  Chapter  3  the  notion  of  the  free-design  parameter  p  and  matrix  L 
was  introduced  to  provide  a  means  of  shaping  the  singular  values  to  meet 
the  design  specifications.   In  this  section,  the  author  will  derive  a  pro- 
cedure to  obtain  a. [G  „  ]  that  are  tied  together  throughout  the  desired 
i  — FOL 

operating  bandwidth,  and  will  eventually  result  in  a  desirable  tight  cross 
pattern  of  the  Model  Based  Compensator  loop  transfer  function  T(s). 

The  filter  open- loop  transfer  function  is  given  in  Eq.  (3-24)  as 


^FOL   =   ^"^ 


-1 


Let  L  be  of  the  form 


L   = 


h 


±2 
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where 


L  is  all  states  excluding  the  integrator  states 
L   is  the  integrator  states 


and,  starting  with  the  full  augmented  system  dynamics  in  the  state  space 
form  as  developed  in  Eq.  (4-2) 


A   = 


A.,^     B 
—10     — i 


0      0 


one  obtains 


si  -  A  = 


SI  -  A1Q     -B, 


Si 


Taking  the  block  inverse 


si  -  A) 


-1 


(SI  -  V 


-1 


(SI  -  A10)_1  B 


(4-3) 


Now  for  low  frequencies 


s  -*-   0 
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C(sl    -   A)~      L 


=    [C,rt         0] 


-10 


-a"1 
-10 


-A^B 

-io  — 


s        _ 


^2 


.  C    A~      B      L 

=     -C     A_1L     -  -  ~10  n  ~2 

-10^10^1  s 


(4-4) 


Hence,    for   small   s,    Eq.     (4-4)    further   becomes 


C(sl    -   A)~      L 


-   £  A"  J    B^    L2 


(4-5) 


By   Eq.     (3-22) 


GF0L(s)       =      C(8I    "   A)"1   L 


To  tie  the  singular  values  together,  it  is  desirable  to  set 

I 


G     a  

-FOL      s 


and,  consequently,  obtain  from  (4-5) 


£  ho : 


-2 


(4-6) 


Finally,  solving  for  L 


k2      -   -  GA^)-1 


(4-7) 
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The  dependence  of  the  low  frequency  singular  values  should  be  clear; 
L2  drives  the  controller  through  the  integrator  states. 

An  analogous  method  was  used  to  the  high  frequency  singular  values 
together.   From  Eq.  (4-3)  it  follows  that 

T    T  -1 
Lx   =  C  (CC  )  (4-8) 

4.3    Model  Based  Compensator  Design 

Equations  (4-7)  and  (4-8)  were  applied  to  both  designs.   Figures 

4-8  and  4-9  are  the  plots  of  the  shaped  a. (G__T )  which  show  how  the 

1   FOL 

singular  values  are  tied  together  at  low  and  high  frequencies.   By  varying 
the  design  parameter  y  ,  these  singular  values  can  be  shifted  up  or  down. 
However,  neither  plot  would  result  in  a  tight  crossover  pattern  at  the 
desired  crossover  frequency  of  0.08  radians/s.   It  is  through  the  use  of 
the  scaling  transformation  properties  developed  in  Eq.  (3-14)  that  the 
shapes  of  these  singular  values  approach  the  desired  shapes  for  good  com- 
mand following,  disturbance  rejection,  and  crossover  frequency  specifications. 

Referring  to  Figure  4-8  it  is  proposed  that  the  minimum  singular 
value,  r,  be  scaled  to  match  the  maximum  singular  value,  9,  at  its  greatest 
separation.   This  point  occurs  at  a  separation  of  about  24  dB,  which  is 
equivalent  to  a  ratio  between  the  values  of  r  and  0  of  16,  at  a  frequency 
of  0.02  radians/s.   For  numerical  convenience,  r  will  be  scaled  by  a  factor 
of  10  (versus  16).   This  means  that  r  will  be  observed  in  "tens"  of  radians, 
while  the  output  9  continues  to  have  units  of  radians. 

A  similar  approach  is  applied  to  figure  4-9.   In  this  case,  the  maxi- 
mum separation  approaches  4  orders  of  magnitude.   For  numerical  convenience, 
y   will  be  sclaed  up  by  a  factor  of  10  (the  same  factor  used  for  r  above) , 
where  z  is  scaled  down  by  0.01. 
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Figure  4-8.   Shaped  and  unsealed  filter  open- loop  transfer 
function;  r  -  6  system;  singular  values  vs 
frequency. 
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PLRNT  2X12  C(SI-flP  L  Z,PSI  DOT,  UNSCRLED 
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Figure  4-9.   Shaped  and  unsealed  filter  open- loop  transfer 
function;  ij;  -  z  system;  singular  values  vs 
frequency. 
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Consequently   the   transformation  matrices,    S      ,    become 

Y 


-1 


10        0 


0  1 


for  the  r  -   9   system  and 


-1 


10 


0.01 


for  the  4*  —  z  system. 

Figure  4-10  and  4-11  show  the  effect  of  scaling  alone  on  the  open- 
loop  transfer  function  C[sl  -  A]    B.   The  transformations  of  (4-9)  and 
(4-10)  have  resulted  in  the  open- loop  transfer  function  being  scaled  up  or 
down  by  the  scaling  factor  applied  to  each  output  as  predicted  in  Eq.  (3-14). 
Note  that  in  these  plots  the  maximum  and  minimum  singular  values  are  plotted 
instead  of  the  singular  values  of  the  outputs.   This  accounts  for  the  appear- 
ance of  the  singular  values  of  Figures  4-10  and  4-11  of  being  pinched  to- 
gether.  If  a.  (GLT )  had  been  plotted,  the  singular  values  would  have  inter- 
sected at  this  point. 

The  final  loop  shapes  of  G    are  found  in  Figure  4-12  and  4-13  where 
both  the  scaling  transformation  (3-9)  and  loop  shaping  Eq.  (4-7)  and  (4-8) 
have  been  employed.   These  loop  shapes  are  nearly  ideal  for  ensuring  a  tight 
crossover  pattern  and  nearly  20  dB/decade  roll-off  throughout  the  operating 
frequency  range.   The  current  crossover  frequency  of  1  radian/s  is  to  be 
expected  due  to  the  asymptotic  behavior  of  <j.(I/s). 

The  final  parameter  to  be  chosen  is  y.   By  Eq.  (3-26) 


1 

—  a  . 


Wju) 
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Figure  4-10.   Scaled  open- loop  plant;  r  -9   system; 
singular  values  vs  frequency. 
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OPEN  LOOP  PLANT  2X12  ZDOT,  P5ID0T  SCALED 
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Figure    4-11.      Scaled  open-loop  plant;    ip   -   z   system; 
singular   values  vs   frequency. 
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Figure  4-12.   Shaped  and  scaled  filter  open- loop  transfer 
function;  r  -  0  system;  singular  values  vs 
frequency. 
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PLANT  2X12  C(SI-R)HL  Z,PSI    DOT,    SCRLED,  SHAPED 
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Figure    4-13.      Shaped  and^ scaled   filter   open- loop   transfer 
function;    ijj    -   z   system;    singular   values  vs 
frequency. 
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and  solving  for  u  then 

max  — FOL  o 

where   6      is   the    (maximum)    desired  crossover    frequency.      The  value   of 
obtained  were    126   and   144  respectively,    for   th<j   r   -   0    and  \p   -   z   controller, 
using  a  maximum  crossover    frequency  of  0.09  radians/s. 

With  the   design  parameters,    y,    L,    and  S        thus   determined,    the   design 

-    -y 

can  proceed  with  the  application  of  the  FARE  Eq.  (3-22)  and  (3-21)  to 

calculate  the  Kalman  Filter  gain  matrix  H.   The  singular  values  of  G 

—  — KF 

are  plotted  in  Figures  4-14  and  4-15.   The  loop  shapes  have  been  re- 
covered in  both  cases  with  crossover  in  the  range  of  0.07  to  0.09  radians/s. 

Finally,  the  controller  gain  matrix,  K  is  calculated  by  the  CARE 
Eq.  (3-20)  and  (3-19) .   The  only  free  design  parameter  to  choose  is  q,  the 
control  weighting  index.   Generally,  to  prevent  control  saturation  from 
high  gain  of  K,  it  makes  sense  to  choose  q  as  small  as  possible  and  still 
meet  the  design  specifications.   In  both  controller  designs,  when  q  was  set 
equal  to  10,  a  crossover  of  0.075  radians/s  was  obtained  by  the  singular 
values  of  the  loop-transfer  matrix,  T  (s) .   These  are  plotted  in  Figures  4-16 
and  4-17.   Note  the  roll-off  at  crossover  is  20  dB/decade ,  as  expected, 
and  that  Eq.  (3-27)  fails  to  hold  at  frequencies  above  0.7  radian/s. 

Robustness 

The  singular  value  plots  of  the  Kalman  Filter  return  difference  and 
Kalman  Filter  inverse  return  difference  matrices  are  shown  in  Figure  4-18 
and  4-19  for  the  r  -  9  system,  and  in  Figure  4-20  and  4-21  for  the  i|>  -  z 
system.   The  robustness  criteria  set  forth  in  Eq.  (3-30)  and  (3-31)  have 
been  met. 

A  discussion  of  the  robustness  of  the  loop-transfer  matrix  according 
to  Eq.  (3-2)  is  given  in  Chapter  5. 
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FREQUENCY    (RRD/5EC) 


Figure    4-14.      Kalman   filter    loop-transfer   function;    r   -    0    system; 
singular   values  vs   frequency. 
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Figure    4-15.      Kalman   filter    loop   transfer    function;    tp   -   z   system; 
singular  values  vs    frequency. 
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COMPENSATED  SYSTEM  30R2  0-10  THETR,  R 
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Figure    4-16.      Loop-transfer   recovery;    r   - 
values  vs    frequency. 


system;    singular 
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Figure  4-17.   Loop-transfer  recovery;  i>   -   z  system;  singular 
values  vs  frequency. 
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Figure    4-18.      Kalman   filter   return  difference;    r   - 
singular   values  vs    frequency. 
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Figure    4-19.      Kalman   filter   inverse   return  difference;    r   -    9    system; 
singular   values  vs   frequency. 
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Figure  4-20.   Kalman  filter  return  difference;  y   -   z  system; 
singular  values  vs  frequency. 
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Figure    4-21.      Kalman   filter   inverse   return  difference;    ty   -  z   system; 
singular  values  vs    frequency. 
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CHAPTER  5 


MODEL  BASED  COMPENSATOR  EVALUATION 


5.1  Compensator  Design  Implementation 

In  this  section,  the  performance  of  both  the  r  -  6  and  ty   -   z  con- 
trollers will  be  tested  on  the  nonlinear  submarine  simulation  to  see  how 
closely  the  performance  specifications  are  met  and  to  check  for  instabili- 
ties.  Note  that  the  linear  plant  dynamics  G(s)  presented  in  the  feedback 
configuration  of  Figure  3-4  has  been  replaced  by  the  nonlinear  plant 
dynamics  of  the  simulation.   The  states  at  point  2  of  Figure  3.4  are 
therefore  the  actual  measure  of  output  variables.   This  means  that  the 
error  vector,  e_(t)  ,  at  the  input  of  the  Model  Based  Compensator  is  always 
the  true  difference  between  the  commanded  input  and  the  output  variables. 

In  order  to  avoid  the  additional  computations  required  to  transform 
the  output  variables  back  to  their  original  units,  the  output  variables  are 
handled  in  their  scaled  form.   To  maintain  a  properly  scaled  error  vector, 
e_(t)  ,  the  true  output  variables  and  the  command  input  variables,  r(t)  ,  are 
multiplied  by  the  appropriate  scaling  transformation.   Figure  5-1  illustrates 
how  the  model  based  compensator  feedback  configuration  for  this  design  imple- 
mentation is  modified  by  scaling. 

5.2  Evaluation  of  Output  Variable  Selection 

Comparison  of  the  two  system  performances  will  be  accomplished  in  this 
section  to  determine  which  rate  control  system  provides  better  performance 
and  robustness  characteristics.   The  performance  evaluation  will  be  based 
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Figure  5-1.   Modifications  of  the  MBC  feedback  configured 
due  to  scaling. 


on  commanding  various  bearing  rates,  while  ordering  zero  pitch  or  zero 
depth  rate  to  the  two  compensators.   The  resulting  behavior  of  the  vehicle 
with  respect  to  depth  will  then  provide  a  common  means  of  comparing  the 
response  of  the  two  designs. 

The  first  simulation  run  for  both  controllers  is  for  a  small  ex- 
cursion about  the  nominal  point  of  1  degree/s  and  zero  feet/s  (or  zero 
pitch  for  the  r  -  9  system) ;  it  is  expected  that  the  nonlinear  model 
should  behave  linearly  in  this  vicinity  and  would  provide  a  gauge  of 
how  successful  the  model  was  in  meeting  some  of  the  performance  specifi- 
cations.  The  entire  state  outputs  for  the  i>   -   z   compensator  simulation 
are  found  in  Figure  5-2.   The  ^  and  z  command  errors  under  the  control 
input  heading  of  Figure  5-2  indicate  the  performance.   It  can  be  seen 
that  settling  times  for  both  outputs  are  indeed  within  50  -  60  seconds 
and  are  in  compliance  with  the  performance  specifications  of  Section  2.6. 
Note  also  that  there  is  already  a  small  error  in  z  after  60  seconds. 
This  error  tends  to  zero  as  more  time  is  allowed  for  the  simulation,  and 
results  in  a  maximum  vehicle  depth  change  of  about  5  feet  for  this  maneuver, 
The  command  errors  of  the  r  -  9  compensator  shown  in  Figure  5-3  exhibit 
nearly  the  same  performance  as  the  ty   -   z  compensator  for  the  heading  rate 
orders,  but  the  9  output  state  experiences  a  small  overshoot.   Figure  5-3 
also  shows  that  as  9  approaches  the  value  of  zero  (level  turn) ,  the  vehicle 
depth  continues  to  increase  without  apparent  bounds.   This  is  not  a  sign 
of  instability,  but  rather  an  indication  that  9  is  not  a  very  accurate 
representation  of  depth  rate. 
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NON-LINEAR  SIMULATION  R-THETA 


H 1 1 1 1 1 1- 


H 1 1- 


H 1 1 1— f- 


H 1 1 1 1 1 1 1 1 

120        IW  160        160        200 


20         go         60         60 


TIME 


X 

1 1 1 1 1 1 1 1 i 1 H 1 1 1 \ 1 1 1 1 

J 

„o" 

^^""^^ 

o 

o 

**    1 

>v 

ujc" 

\. 

cr 

\^ 

1—      ^ 

X- 

^— 

o. 

■ 1 ( 1 1 1 1 1 i 1 1 1 1 1 1 1 1 1 1 1 

20        HO  60        80        100       120       HO       160       180       200 

TIME 


-I 1 1 1 1 1 1 — + 1 1 1 1 H 


ISO        200 


Figure  5-3.  Nonlinear  simulation  showing  output  error  and 
response  for  r  -  0  control  system  in  vicinity 
of  nominal  point. 
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When  bearing  rates  were  much  greater  than  the  nominal  rate,  the 
system  behaved  in  a  much  different  fashion.   The  simulation  results  in 
Figures  5-4  are  for  a  commanded  bearing  rate  of  2  degrees/s,  or  about 
double  the  nominal  rate.   Note  here  that  the  time  scale  has  been  expanded 
to  400  seconds.   The  output  error  of  ty   takes  almost  120  seconds  to  settle, 
while  the  z  error  shows  indications  of  settling  at  some  time  greater  than 
400  seconds.   Figure  5-5  demonstrates  similar  results  for  the  r  -  8  con- 
troller; the  8  error  state  has  nearly  the  same  shape  as  the  z  error  state 
except  for  a  different  sign.   Note  that  the  dynamics  of  z  and  8  are  rather 
complicated  and  certainly  not  harmonic  in  nature.   This  is  no  doubt 
caused  by  the  nonlinear  behavior  of  the  submarine. 

Ordinarily,  performance  measures  are  given  in  the  form  of  settling 
times,  rise  times,  percent  overshoot,  etc.  These  conventional  measures 
cannot  be  applied  exactly  (unaltered)  in  this  case  due  to  the  nonlinear 
behavior  that  would  render  such  indices  meaningless  or  misleading.  For 
instance,  a  steady-state  output  error  may  prolong  the  measure  of  system 
settling  time,  although  the  output  error  may  have  reached  this  particular 
state  in  a  relatively  short  time. 

Quantitative  comparisons  will  be  made,  instead,  through  perform- 
ance indices  that  are  based  on  an  integral  error  of  the  form 

P.I.   =      e(t)  dt 
0 

for  a  step  input  of  y  ,  the  commanded  output,  the  integral  error  becomes 


— c 


Sf 


p.i.  =  y    t  -   f  y(t)  dt  (5-1) 

-c    f    JQ 


85 


en 


—I    ° 


az    7 


o     -J 
(X      i 


>      z 


is/ii)   n 


g 

CD 

-p 

0) 
>1 


O 
■P 

c 
o 
u 


M 

0 

M-l 

C 

0 

■H 

■P 

fC 

H 

• 

3 

■P 

g 

C 

•H 

•H 

CO 

0 

a 

B 

rH 

0) 

t0 

c 

c 

■H 

•H 

H 

g 

c 

0 

o 

C 

fi 

£ 

© 

u 

■p 

U 

tu 

H-l 

H 

Qa 

>1 

g 

n3 

0 

5 

u 

ro 

t 

^r 

IT) 

<D 

'3 

tF 

■H 

fe 

§  1 

!r  ! 

ID      i 

UJ 

h-      - 

o    i 


Q 


CC     <- 


Q 


B 
CD 
+J 

en 

>i 

CO 


0 
U 

■P 

c 

o 
u 


u 

0 

.^ 

4-1 

• 

4-> 

c 

G 

0 

0 

-H 

C) 

+J 

03 

H 

• 

3 

■P 

g 

C 

•H 

-iH 

en 

0 

a 

M 

rC 

rH 

CI) 

<u 

c 

c 

•H 

•H 

H 

e 

c 

0 

0 

c 

c 

e 

0) 

0 

-u 

m 

a; 

44 

rH 

ft 

>i 

i= 

rd 

0 

s 

u 

re 

# 

^r 

in 

0) 

g 

& 

■H 

fa 

e 

+J 

en 
>i 
w 


CO 

I— 

ID 


C_J 


o 
n 

-p 
c 
o 
o 


GO 'J3 


M 

0 

*-^. 

m 

• 

+J 

C 

c 

0 

0 

■H 

u 

-U 

■*-• 

16 

H 

• 

3 

4J 

e 

c 

■H 

•H 

to 

0 

a 

M 

(fl 

rH 

(1) 

m 

c 

c 

■H 

■H 

H 

g 

c 

o 

0 

c 

c 

6 

<D 

0 

4-1 

n 

0) 

M-l 

rH 

CU 

>1 

g 

n3 

0 

!5 

u 

nJ 

# 

<* 

in 

•H 

fa 


88 


NON-LINEAR  SIMULATION  R-THETA 
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Figure  5-5.   Nonlinear  simulation  showing  output  error  and  response 
for  r  -  0  control  system  away  from  nominal  point. 
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This  is  a  particularly  useful  and  convenient  measure.   As  it  turns 
out,  the  change  in  depth,  or  depth  excursion,  in  a  specified  time,  t  ,  of 
a  submersible  that  is  commanded  to  maintain  a  constant  depth  is  equal  to 
the  depth  rate  integral  error.   Equation  (5-1)  will  not  be  applied  pre- 
cisely to  the  r  -  9  controller;  however,  the  resulting  depth  excursions 
and  heading  errors  provide  a  common  means  to  compare  the  performance  of 
the  two  control  systems.   These  results  are  plotted  in  Figures  5-6  and 
5-7.   Figures  5-6  shows  no  significant  differences  between  either  control 
system's  yaw  rate  integral  errors.   Several  conclusions  can  be  drawn  from 
Figure  5-7,  however.   Both  controllers'  performance  is  best  near  the 
nominal  point  bearing  rate  (1  degree/s) ,  although  it  can  be  seen  that 
the  depth  excursion  of  the  r  -  9  controller  is  greater.   Again,  this  is 
not  surprising  since  6  is  only  a  partial  description  of  the  full  depth 
expression  [  (Eq.  (2.14))].   For  an  equal  interval  of  1  degree/s  on  either 
side  of  the  nominal  point,  the  depth  excursions  of  the  ty   -   z   controller 
are  nearly  symmetrical  with  respect  to  the  nominal  point,  whereas  the 
error  of  the  r  -  0  controller  is  less  at  lower  turning  rates.   In  either 
case,  the  controllers  provide  better  depth  control  than  otherwise  achiev- 
able by  manual  means,  although  the  rapid  increase  of  depth  for  commanded 
turning  rates  greater  than  2  degrees/second  or  less  than  0  degree/second 
(opposite  turn)  may  be  an  indication  that  the  system  is  becoming  less  stable 

It  is  very  unlikely  that  a  submarine  would  stay  in  a  maneuver  like 
this  for  very  long  since  it  would  have  completed  a  full  (360  degee)  turn  in 
about  3  minutes.   A  more  realistic  operating  scenario  was  simulated. 
Figure  5- 3  shows  a  series  of  maneuvers  in  response  to  various  reference 
inputs  listed  in  Table  5-1.   Which  are  in  the  form  of  fast  ramps  (1-5 
seconds) .   This  is  to  simulate  the  commands  an  operator  may  issue  through 
the  "joy-stick"  in  maneuvering  his  vehicle.   An  interesting  observation 
in  Figure  5-3  is  that  commanded  changes  in  9  have  very  little  effect  on  r 
as  indicated  by  points  1,  3,  and  4;  however,  the  commanded  change  in  r 
does  have  a  substantial  effect  on  the  error  in  0 ,  as  seen  in  point  2. 
Point  5  of  Figure  5-6  shows  the  effect  of  commanding  simultaneous  changes 
in  r  and  0 . 
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Figure  5-8.   Output  error  response  to  various  commanded  inputs 
for  r  -  8  control  system. 
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Table  5-1.   Nonlinear  simulation  r  -  e.   Time  and  the 
corresponding  reference  inputs. 


TIME 

r 

e 

Point 

SEC 
0.0 

(10    deg/s 

)       (deg) 

-.100000E+02 

O.OOOOOOE+00 

® 

60.0 

-.100000E+02 

O.OOOOOOE+00 

61.0 

-.100000E+02 

0.200000E+01 

® 

100.0 

-.100000E+02 

0.200000E+01 

101.0 

0.000000E+00 

0.200000E+01 

9 

200.0 

0.000000E+00 

0.20C000E+01 

201.0 

o.noooooE+oo 

0.000000E400 

@ 

300.0 

0.000000E+00 

O.OOOOOOE+00 

305.0 

O.OOOOOOE+00 

0.500000E+01 

375.0 

O.OOOOOOE+00 

0.500000E+01 

380.0 

0.000000E+00 

O.S00OOOE+01 

© 

440.0 

0.000000E400 

0.500000E+01 

445.0 

-.150000E+02 

0.200000E+01 

500.0 

-.150000E+02 

0.200000E+01 

The  full  response  of  the  0  -  z  compensator  to  various  command  in- 
puts are  shown  in  Appendix  C. 

5. 3     Robustness 

To  determine  how  close  the  controller  is  to  being  unstable,  recall 

that  E    (s)  was  given  by 
—pre  J 


E    (s) 
-pre 


=   [G(s)  -  G(s)] 


G-1(s) 


(3-1) 


It  is  clear  that  for  this  simulation  G(s)  above  is  a  function  only  of  the 
system  nonlinearities  since  the  hydrodynamic  coefficients  remain  as  pre- 
determined constants.   The  structure  of  G(s) ,  then,  can  be  found  for  any 
operating  condition.   Note  in  Figure  5-9  that  a  commanded  i|i  of  -2  degree s/s 
corresponds  roughly  to  8  degrees  of  rudder.   Since  this  region  of  controller 
operation  appears  to  be  approaching  its  performance  limit,  G(s)  will  be 
determined  by  linearization  of  the  submarine  dynamics  about  8  degrees  of 
rudder. 
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Figure  5.9.   Steady  state  rudder  required  to  achieve  commanded 
bearing  rate. 
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System  robustness  will   then  be    studied  through  the    inequality 


amax[Ve(jw)]   -  W^  +    (<^w>    K(jo)))"1]  (3-2) 


Figures  5-10  and  5-11  provide  a  graphical  interpretation  of  Eq.  (3-2)  above. 

In  both  instances  the  maximum  singular  values  of  E    (s)  are  equal  to,  or 

—pre 

slightly  larger  than  the  minimum  singular  values  of  the  inverse  return 
difference  matrix  of  the  loop-transfer  function  for  the  bandwidth  up  to 
0.1  radians/s.   Hence  the  inequality  (3-2)  above  is  not  satisfied  and 
stability  can  no  longer  be  guaranteed. 

For  the  i>    -  z  compensator  of  Figure  5-11  a  bulge  forms  in  the 

singular  values  of  E    (s) .   This  is  most  likely  due  to  the  presence  of 

—pre 

non-minimum  phase    zero   in   the  ty    -   z   system  since   the   difference   between 

E         (s)    of   either    system  can  only  be   attributed  to  the  C  matrix  used   for 
—pre  — 

the   outputs.      Although  the  maximum   singular   value   of  E         (s)    is   not   greater 

_1  ~Pre 

than   the    singular   values   of    (,1  +  T      (s)  )    near   the   bulge,    it   is   typically 

at   these    higher    frequencies   and   above   that  other  modeling  errors    (such  as 

unmodeled  dynamics)    are    likely  to  occur    in   an   actual   submarine.      The   combina- 


tion of   the   unmodeled  errors   in  G(s)    and  the  bulge   in  E         (s)    for   the   \b   -   z 

—  —pre 

controller  is  more  likely  to  result  in  an  unstable  system  than,  say,  rela- 
tively flat  singular  values  of  E    that  appears  in  Figure  5-10. 

5. 4    Gain  Scheduling 

Gain  scheduling  involves  the  use  of  more  than  one  set  of  matched 
Kalman  filter  gain  matrices  (H)  and  control  gain  matrices  (G)  to  provide 
the  compensator  with  the  ability  to  extend  acceptable  performance  and  ro- 
bustness requirements  over  the  widest  possible  range  of  operating  condi- 
tions.  These  operating  conditions  for  the  rate  controller  design  can  be 
expressed  here  in  3-dimensional  "volumes".   This  concept  is  shown  if 
Figure  5-12.   The  specification  of  speed,  rudder  deflection,  and  stern 
plane  defection  define  a  single  point.   On  this  diagram,  one  can  plot 
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Epre   ,     (I    +   T"'  )    FOR   R-THETfl   SYSTEM 


-i 1 — i — i — i  i  i  1 1 
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Figure   5-10.      Inverse   return  difference   of  recovered  transfer    function  and 
premultiplicative   error;    r   -    0    system;    singular  values  vs 
frequency. 
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Figure    5-11.      Inverse   return   difference   of  recovered  transfer    function 
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Figure  5.12. 


Schematic  showing  operating  volume  for  determination  of  model 
robustness  and  acceptable  performance  near  a  nominal  point. 
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regions  where,  about  a  nominal  point (s) ,  the  multiplicative  error  can  be 
determined  and  robustness  checked  in  a  test  similar  to  Eq.  (3-2)  above. 
This  is  called  the  region  of  guaranteed  stability.   Another  volume  on  the 
same  plot  is  reserved  for  performance.   It  includes  all  points  about  the 
nominal  point  that  result  in  acceptable  performance.   The  intersection  of 
the  stability  region  and  the  performance  region  defines  the  outer  bounds  of 
the  operating  range  of  the  particular  set  of  gains.   Many  nominal  points 
together  would  be  required  to  cover  the  full  possible  operating  range  of 
the  submersible. 

Gain  scheduling  can  then  be  accomplished  by  two  possible  approaches: 

(1)  Establish  large  overlapping  volumes  around  nominal  points 
where  particular  set  of  gains  (including  corresponding  models 
of  the  A,  Ei,  and  C  matrices)  are  satisfactory  with  respect 

to  performance  and  robustness.   The  shift  of  gains  from  one 
region  to  another  would  be  through  a  band-bang  implementation. 
This  procedure,  of  course,  requires  implementation  schemes 
that  would  allow  the  gain  shift  to  occur  without  violent 
transients  of  the  control  surfaces. 

(2)  Select  nominal  points  to  span  the  volume,  and  schedule  the 
gains  of  the  compensator  through  a  quadratic  or  least  squares 
fit  of  the  operating  conditions  through  the  nominal  points. 
Lively  [14]  has  successfully  implemented  such  a  methodology. 
It  becomes  difficult,  however,  to  evaluate  the  robustness  by 
methods  used  in  this  thesis.   One  must  somehow  ensure  that 
all  quadratically  obtained  gains  result  in  enough  robustness 
to  overcome  the  unmodeled  dynamics. 

5.5    Other  Notes 

When  q,  the  control  gain  weighting  index  is  increased  over  the  value 
of  10  used  in  this  design,  the  gain  entries  of  G,  of  course,  increase.  The 
result  is  that: 
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(1)  The  bandwidth  of  T(s)  increases  slowly  to  match  the  crossover 

of  GVT1. 
— KF 

(2)  The  control  surface  deflections  for  maneuvers  similar  to  those 
performed  in  this  chapter  increased,  and  tended  toward  satura- 
tion as  q  increased  further. 

(3)  The  maximum  rate  limits  of  the  actuators  were  exceeded. 

(4)  There  was  no  noticeable  increase  in  performance.  Therefore, 
the  value  of  q  was  kept  as  small  as  possible  consistent  with 
meeting  the  minimum  bandwidth  requirements. 

5.6    Chapter  Summary 

The  performance  comparisons  of  and  between  the  two  compensator 
designs  are  far  from  complete.   It  was  the  intent  of  this  chapter  to  show 
how  one  could  begin  to  evaluate  a  design;  a  full  evaluation  of  each  con- 
troller would  require  many  more  calculations  to  be  completed.   One  might 
conclude  at  this  point  that  linearization  required  to  obtain  the  C  matrix 
used  in  the  ty   -  z  controller  has  resulted  in  a  somewhat  less  robust  design. 
However,  the  ^  -  z  controller  provides  more  precise  control  of  turning  and 
depth  rates  which  is  the  ultimate  control  objective  of  this  design. 

The  question  of  robustness  away  from  the  nominal  point  chosen  in 
this  design  was  only  partially  ansered.   Nonlinearities  most  likely  pro- 
vide the  greatest  source  of  modeling  errors.   Other  dynamics  that  arise 
from  errors  in  the  hydrodynamic  coefficients  and  unmodeled  dynamics  are 
not  known  at  this  time  but  are  required  in  order  to  complete  the  robustness 
picture  before  a  practical  design  can  be  produced  for  a  real  submersible. 

The  control  gain  matrices  for  both  control  systems  are  found  in 
Appendix  B. 
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CHAPTER  6 


CONCLUSIONS 


6. 1    Summary 

Multiple -input  multiple  output  control  system  design  methodologies 
has  been  successfully  employed  to  provide  a  means  for  an  operator  of  a  sub- 
mersible to  control  heading  and  depth  for  complicated  maneuvers.   This 
study  is  far  from  a  completed  design.   However,  results  thus  far  are  en- 
couraging.  Of  significance  this  thesis  has: 

(1)  Provided  one  of  few  available  examples  of  a  complex  LQG/LTR 
Model  Based  Compensator  designs  evaluated  on  a  nonlinear 
simulation. 

(2)  Developed  a  loop-shaping  technique,  using  integrator  aug- 
mentation in  the  command  input  channel,  in  which  singular 
values  can  be  brought  arbitrarily  close  together  and  then 
recovered  through  natural  scaling  of  the  output  variables. 

(3)  Compared  the  performance  and  robustness  of  rate  control 
designs  based  on  a  constant  C_  matrix  (the  r  -  9  controller) 

•       •  •       • 

and   a   linearized  C  matrix    (the  ty   -   z   controller)  .      The   ifj   -   z 
controller,    which  directly  controlled  the   heading  rate,    ty , 
and  the   depth  rate,    z,   provided  better   control  of  the    sub- 
marine  depth   in  a   turn   than   the   r   -   6    controller   design. 
Heading  rate   control  was  essentially  equal   in  both  designs. 
However,    the    linearized  C  matrix  of   the   ty   -   z  design   showed 
potential   for    less   stability  as   the   vehicle    states   deviated 
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from  the  nominal  point.  The  non-minimum  phase  zero  of  the 
\\>  -  z  controller  was  outside  the  desired  bandwidth  and  did 
not  effect  the  loop-transfer  recovery  process. 

6.2    Recommendations 

Much  more  work  can  be  done  to  further  provide  practical  uses  of 
the  MIMO  LQG-LTR  methods  used  in  this  thesis  and  to  take  a  deeper  look 
into  achievable  submarine  performance  through  rate  control  systems.   Some 
topics  not  thoroughly  covered  in  this  thesis  that  could  provide  a  basis 
for  further  research  include: 

(1)  A  demonstration  of  stability  and  performance  as  a  function  of 
state  variable  scaling  to  see  if  the  natural  scaling  pro- 
cedures developed  in  this  thesis  effect  the  actual  performance 
bandwidth  over  unsealed  state  variables  or  designs  with  differ- 
ent scaling  methods. 

(2)  Determining  an  error  norm  that  combines  both  the  known  errors 
due  to  the  model  deviations  from  linearity  as  well  as  errors 
that  estimate  the  tolerances  of  the  hydrodynamic  coefficients 
and  other  modeling  errors  in  order  to  provide  a  better  picture 
of  the  achievable  compensator  robustness. 

(3)  Checking  the  performance  of  the  model  in  response  to  environ- 
mental noise. 

(4)  Developing  a  practical  method  of  gain  scheduling  so  the  con- 
troller provides  good  performance  in  all  attitudes  and  speeds. 

(5)  Determining  how  scheduling  the  sail  planes  (the  k  factor  in 
Eq.  (2-11))  effects  the  performance  and  stability  of  the  sub- 
marine . 

(6)  Applying  the  design  procedure  used  in  this  thesis  to  develop 
control  systems  for  different  fin  configurations,  to  possibly 
include  "Y"  and  "X"  sterns,  and  differential  control  of  a 
cruciform  stern. 
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Table  A-l.   Dynamical  response  terms  (Abkowitz) 

Body  Properties 

Length 

Geometry 

Mass 

Moments  of  Inertia 


Properties  of  Motion 


Orientation 


o   o   o 


<{>,  6,  i> 


fixed  coordinate  system,  reference  at  surface 

angular  rotations  about  the  x,  y,  and  z  axis, 
respectively 


Body  Motion 

-*■ 

U  linear  velocity  vector 

-*■ 

0,  angular  velocity 

• 

U  linear  acceleration  vector 

• 

fi  angular  acceleration 

6  control  surface  deflection 

• 

6  control  surface  velocity 

6  control  surface  acceleration 

n  propeller  angular  velocity 

n  propeller  angular  acceleration 


Fluid  Properties 


p 

mass  density  of  fluid 

g 

M 

viscosity 

P 

T 

surface  tension 

p, 

V 


acceleration  of  fluid 
pressure  of  fluid 
vapor  pressure  of  fluid 
elasticity  of  fluid 
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A. 2       Nonlinear  Equations  of  Motion 

Explanation  of  Conventions  used  in  Hydrodynamic  Coefficients 

Hydrodynamic  coefficients  used  in  the  nonlinear  and  linear  equations 
of  motion  are  generally  written  in  the  form 


X  V. 

ab.  . 


where  X  represents  a  force  or  moment  and  the  subscripts  a,  b,  ...  represent 
an  angular  velocity,  linear  velocity,  rudder  deflection,  etc.   The  con- 
ventional meaning  of  coefficients  written  in  this  form  is 


x  u         =    T7 — k — r   [x] 

ab.  .  .      3  (a,  b.  ... ) 


which  are  taken  to  be  Taylor  expansion  coefficients. 

Moments  of  inertia  are  written  in  similar  form,  but  all  subscripts 
following  retain  the  usual  meaning  of  coordinate  system. 
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1  .         SURGE 


m[u   +  qw  -  rv  -  xQ(q     +  r    )    +  yQ(pq   -  r )    +  zQ(pr   +  q ) ]      = 

o      4r  2  2  i 

rr  I    |  X      q      +   X      r      +    X      rp 
2        L    qq  rr  rp  rj 

+     £■  I    [x«u   +    X      vr    +   X     wql       +     £  £2[x      u2    +    X      v2    +   X     w2] 
2        L    u  vr  wqJ  2Luu  w  wwJ 

+     £-  £    u    Fx.    .    5r      +    X.     .    5s      +    X.^.Sb    1       +      (PROPTH   -   DRAG) 
2  L   5r6r  6s6s  5b6b        J 

+    ^  Z2(n-D   [x      v2  +  x      w2  +  x.    .     u2n6r2  +  x.   .     u26s2" 
2  L    wn  wwri  ororn  5sosn  J 

-  WTOT  sin  9 


2     2 

PROPTH  -  DRAG   =   u  ( c  .  n   +  b  .  n  +  a . ) 
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2.  SWAY 


m[v  -  pw  +  ur   -  yQ(r      +  p    )    +  zG(qr   -  p)    +  xG(qp  +  r)]      = 

|*V;r   +   Y-p   +   Y    I     iplpl    +   Y     pq   +   Y     qr   +   I        sign    <r,v)    A\  w2' 


P  P      I     I  pq  qr  rv 

%  l   [Y^r^  +  T-ur   +  Y~UP  +  Yl    I*   ulr  1 5rl      + 

2        Lwp  r  p  r  5r    I  J 


P      2r         2  /~2  2  ? 

+     ^  Z    [Y  u      +Yuv   +   Y|iv  v/v     +  w  +      Y     u   5r    + 


+      Y     vw  u//u      +   v      h  w  +  WTOT   sin   <b    cos    9      + 

^7V  J 


vw 


(n-1)    ft  i3  Y     ur  +  2-  l2  Y     uv+^£2Y.     u25r     + 
2  m  2  vti  2  6m 


/  2  2    i  * 

I       wv      +  w       \    +   Y  +   Y 

r  m  J  CRFL         V] 


P       2 

2  v   r  m  J  CRFL  VTX 


Y  :    {-B-{-l2  —*??. )}    /      H(x)v(x)    /v2(x)    +  w2(x)    dx 


CRFL      i    "2  *•    "       ,  ;|    Ji 

J    D(x)dx 


x. 


*                r     D        2          Zw                      l  r    fw                — 

YVTX:      ^  ~2    *     ~ J  J           w(x)v      (t   -  t    )    dx    ;    not   included   in 

(x,      -  x      )  x                                                          IBM   program, 

fw          so  vs 


sign(r,v)   =  r  •  1 — r 

n 

tx:   time  it  took  vehicle  to  travel  a  distance  x  in  the  axial  direction 


109 


3.  HEAVE 


m[w  +   vp   -  uq   -   zQ(p      +  q    )    +  xQ (rp   -  q)    +  yQ(rp   +  p) ]      = 

£■  £4[z-q  +   (z     r2   +  Z     rp) 
2        L   q  v    rr  rp      ' 


/  2         2         : 
/u      +  V      +  w 


P     »  3|"„    *  „  u  _  w/2  2     I      I 

£  £      Z»w  +    Z      vr  +      Z    I     |    i — t-  /v      +  w        q        + 


+ 

w  vr 


+      Z    I     |    -i — |-  /v      +  w        < 

/i — 2 — 2       wh  n  ' 

/u      +   v      +  w 


+      Zuq   +   Zi     I    u  |q  I  5  si      + 

q  q      I    I 

2 

P„2r„                         u  2  vu 

+     ^  £        Z        vp  +■  Z   u      +  Z 

0  I        T7T1  ——————  r  *  1 


2  L    vp     — *  w 


/  2  2  2  /  2  2  I 

/u      +V+W  /u+v+w 


/  2  2  2  2  ii 

+     Z    i     i    /v     +  w     W  +     Z   uw  +   Z„    u   5s    +  Z.,  u  5b   +  Zi     iu  w       + 
ww  w  5s  5b  w 


1/2  2 

w     /v      +  w       I    +  WTOT   cos    d>    cos    9      + 


rD3  02  p2  /22 

+      (n  —  1  )    lx  I      Z      uq   +  £  £      Z      uw   +  H    Z    ]     i      w/v      +  w  + 

1  2  qn  2  wri  2  w  w  n 


+     I  ^sr/53    }       +      ZCRFL    +   ZJtx 


Z =      -  P-     f   C.Dxwfx)    /v    (x)    +  w    (x)    dx 

CRFL  2     J„      d 

£ 


fw 
Z*  =     —  £   C  f      v(x)    v,    (t  -  T    )dx    ;    not   included   in    the    IBM 

VTX  2  y        J  fw  x  nirn„nm 

-1      x  program, 

vs 
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4.   ROLLING  TORQUE  (<j>) 


V  +    (Iz    '    Xy)qr   "    {'T   +  M>Ixz   +    (r2   "  q2)lyz   +    (pr  "  q)Ixy     + 
m[y_(w  -  uq   +  vp)    -  z    (v  -  wp   +  ur)]      = 

G  G 

£■  4      I"k»p   +   K»r    +   K    I     iplpl    +  K     qr    +  K     pql      + 

2        Lp         r         ppll        qr  pq 

P    ,4 


+     £■  I      [k-v  +  K  ur   +  K  upl      + 
2  L    v  r  p      J 


_         o  5  / ^  9  9 

+     4-  A      [K^u      +   K        uv   +  K    I     I    v/v     +  w     +   Kr    u   5r    +  K     vw      + 
2  L    *  v  v  v|  5r  vw 

+     (n-DK.   u2] 

-    (z   WTOT   -  z_B)    cos    8    sin   <J»    +    (y   WTOT   -  y_B)    cos    8    cos   $    + 
G  B  G  B 

+     [u      +  vt  +  wj    [<4tBt  sin   4*t  +  k8tSt  sin   8* J      + 

fw 

+     %  i   C   Z        /      w(x)    v    (t  -  x    )dx 
2  v         J  w  x 

X 

vs 


v        =     v   +  x  r 
t  t 


w        =     w  -  x  a 
t  t1 


w 

-1   /       t> 

i        =     tan        I J 

t  v      v   J 


-1  /  2  2, 

S         =      tan      /v      +  w   /u 
wt  t  t 
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5.    PITCHING  TORQUE  (9) 


I  q  +  (I   -  I  )rp  -  (p  +  qr)I   +  (p   -  r  )I   +  (qp  -  r)I    + 
y      x    z  c         -    ^   xy  zx    v      yz 

z  (u  -  vr  +  wq)  -  x  (w  -  uq  +  vp)    = 
G  G  J 


£-  I      [M»q  +  M  r4 


/  2  2  2 

/u   +  V   +  w 


+  ^r  I  [m»w  +   Mi     I       q/v      +w        +  M  uq    +   Mi     l  «    ulqlSsl       + 

2  L    w  w  q  q  q  6s    II       J 

o       3  r  2  2  u  

+  ^  t  I  M^u      +  M,       v     .  /   2  2 

2  L     *  5s  /■— - r      +   M    i     i    w/v      +  w      +  Ml     iu 


2  2  2  ww  w 

u      +   v      +  w 


2  2  '22 

+  M.    u  5s  +  M.,u   6b   +  Mi     I    u  w      +  M    I     i      w/v      +  w 

6s  6b  w  |        I     I  w  w       |     I 

-    (zWTOT  -  z    B)    sin   9    -    (x   WTOT   -   x   B)    cos    9    sin   <j> 
G  B  G  B 


+    (n-1)    \    ^  l      M      uq+^-4      M      uw+^-Jl      Mil      w/v    +w      +  Mp      u    5s  1 
1    2  qn  2  wri  2  w  w  n  5sn  J 

* 
+•    M„  +   M 

CRFL  VTX 


MCRFL      =      2  ^    °d   X    °(X)    W(X)    /v2(x)    +  w2(x)      dx 
I 


fw 


M,mw      =      -  rr  I   C        /      x   v(x)    vf    (t   -   t    )    dx    ;    not   included    in    IBM. 
VTX  2  v     J  w  x 

x 
vs 
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6.    YAWING  TORQUE  (i|>) 


I  r  +  (I   -  I  )pq  -  (q  +  rp)I   +  (q  -  p  )I   +  (rp  -  p)I    + 
z      y    x  yz  xy     r   r  zx 


+  m[x  (v  -  wp  +  ur)  -  y  (u  -  vr  +  wq)] 


G 


£■  £      [N»r+N«p  +  N     qr+Nri     i    rlrl    +  N     pql    + 
2  L    r  p  qr  r  pq      J 


qr  r         I     I  pq* 


o4r  /    2  2  •  lli 

—  £        Ni     i      r/v     +w        +Nwp+Nur+Nup+N«v+N||„ur5r        + 

2  L      v  r  wp  r  p  v  r  or    I  J 


o      3    r         2  /  2  2 

+     —  £         N   u      +   N    I     |    w  v      +  w      +   N  uv    + 


N      ywu_ 


V    V  V  vw 


/  2  2  : 

/u      +    V      +   w 


+    (n-D    [4  i4N     ur    +  ~  £3N     uv   +  ~r  £3   N    i     i       v/v2   +  w2      + 
L  2  m  2  VTi  2  v  v  n 

* 

+    (x   WTOT   -  x   B)    cos   9    sin   d>    +    (y^WTOT   -  y   B)    sin    9    +  W„„„r    +  WTrm„ 
G  B  G  B  CRFL  VTX 


N_PT      =      -  ^C.      /    x    H(x)    v(x)    /v2(x)    +  w2(x)    dx 
CRr  Li  £.      ay    ' 

£ 


fw 


N,™„     =     -  ^r  £   C        /      x  w(x)    vf      (t  -  t    )    dx    ;    not   included   in    IBM 
VTX  2  v     ;  w  x 

x 
vs 
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KINEMATIC  RELATIONS 


2       2     2     2 
U   =  u   +  v  +  w 


z   =  -u  sin  9  +  v  cos  9  sin  *  +  w  cos  9  cos 
o 


=  p  +  <|i  sin 


•     q  -  ty   cos  9  sin 
cos  <b 


•  r  +  9  sin 

*  = 


cos  9  cos 
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A. 3  Parametric  Linearization 


I.         AXIAL    FORCE    (SURGE) 


[m   -   Xu]Au  -  my„Ar   +  mz   Aq      = 
G  G 

2  2  2 

3     Au   [2u   fx       +  a.    +  b.n    +  c.n      +  X.    .    5r     +  X.    ,    6s        + 
L      ol    uu  l  i  i  5r6r  5s6s 

+  ^wxL'Sb2   +    (n    -1  )(Xjb    *      5r2   +   X.  5s    )}]      + 

5b6b  o  A6r6m  5s6sri  '  J 


+  Av 
+  Aw 
+  Ap 
+  Aq 
+  Ar 
-  A8 


2(X        +    (n    -1 )X        }v      +    (X        +   m)r    '       + 
w  o  wn      o  vr  oJ 

2JX         +    (n    -1  )X         }w      +    (X         -   m)q    '       + 
L    ww  o  wwn '    o  wq  o J 

-myrq^  -    (mz      -   X      )r   ]       + 
Go  G         rp     oJ 

(X        -  m)w      -   my   d      +    2(mx„   +   X      )q  + 

wq  o  Go  G  qq      oJ 

(X        +  m)v     +    (X        -  mz,,)?     +    2(mx„  +   X      )r   l 
vr  o  rp  6     o  G 

(WTOT   -   B)    cos    9 


rr     o- 


+  A5s    [2(X.    .      +  X.  (n    -1  ))5s   u    1 

L        5s6s  osfisri      o  o   oJ 


+    A5b     [2X,KAHU  JhJ 


5b6b  o     o- 


2 

+  A6r   [2(X.    .      *•  X,    .       (n    -1  ))6r  u   1 
L        5ror  5rom      o  o   oJ 

2  2  " 

+  An    [u    (b.    +    2c.  n    )    +   X        v      +   X        w" 
L    o      i  i    o  wri    o  wwri    c 


2>    2, 


+  (X.    .      5s      +   X,    .    5r   )u   1 
^    5s5sn      o  5r5r     oJ    oJ 
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II.       LATERAL    FORCE 


[m   -  Y»]Av  -    (mz„   +   Y»  )   Ap      +    (mx„   -   Y»  )Ar 
v  G  p  G  r 


Au   [2a   {Y+  +  Y.   6r   +    (n    -1  )Y        5r   -     -^ — - 
Lol*  5r  o  5rti  2^2 


y     u   v  w 
vw  o  o  o 


f    *  2  2>  3/2 

(  U        +    V        +    W  ' 

*■    o  o  oJ 


v      {  Y      +    (n    -1  )Y        + 
o    l    v  o  vri 


y     w 
vw  o 


/      2  2  2 

/    U       +    V       +    w 

o  o  o 


}         +        YnP.        + 


P  o 


+  r      {(Y     -  m)    +  Yi     i- 5r   +    (n    -1  )Y  + 

olr  r  or     r  o         rn 


Av   [u   (y 


y     w 

vw  o 


oL    V 


/  2  2  2 

•  u      +   V      +   w 
o  o  o 


(1  - 


2  2  2 

U       +    V       +   w 
o  o  o 


)   +  (n  -DY 


+  v    {■ 


r 

v   r        v  0 

o 


2 

w  v 

+  (y   i    i+  (n-D    I    I   )•(   1  +    -|- +  ° 

■  ^    v  v  v  v  n  ^ 

/2           2                             I                              '                       v  /   2           2 

/v      +  w                                                                                   o  /v      +  w 


)'J 


o  o 


o  o 


3Y 


+   Y     q      + 


CRFW 


vq   o  3  v 


+  Aw   [u      { 


Y      v 
vw  o 


/  2  2  2 

/u      +   V      +  w 
o  o  o 


(1  - 


2  2  2 

U       +    V       +    w 

o  o  o 


)} 


+    v       { 
o    L 


/  2  2 

/  V       +   w 

o  o 


( * 


+    Y    I     i    +    (n    -1)Y    i     |     )} 
v|r|     | v_ |  v  v  o  v  v  n 


+  p    {  Y        +  ml    +   Y      r      +pm   + 


3Y 


ol    wp 


wr   o  o 


CRFW 
3w 
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+  Ap   [  u   Y      +w(Y        +   m )    +  p   (  2my _   +    2  Yi     l  )    +  q    ( Y        -   mx    ] 1    + 

c    L    o   p  o     wp  co^      JG  p  P  P  o      Pq  gJJ 


3Y 


Aq    FY      v      +  p    (Y        -  mx    )    +  r    (Y        -   mz    )    + 


CRFW 


+  Ar    fu   f  (Y     -  m)    +   2Yi     i.      -t- 2f  5r   +  Y      (n   -1)}    +  v  {y 
Lolr  r  o  r     r  rrio        J  ol 

I    o| 


v  r      |  v 


1       /  2  2   i  ._  ,  __  8YCR 

•   —  /v+w      [      +Yw+q(Y        -  mz    )    +  r   •    2my„   +  — r— 

r  o  oJ  wro^oqr  G  o  G  3r 


CRFW 


+  A*    [  (WTOT   -   B)    cos    9      cos    <j> 

L  o       oJ 

+  A9  [-(WTOT  -  B)  sin  9   sin  6 

1  o      oJ 

+  A6r  [Yi  i.  u  |r  I  +  {y.   +  (n  -1 )Y.   }u2] 
L   r  6r  0|  ol    L  6r     o    5rnJ  oJ 


2  2 


+  An    [Y     ur     +Y     uv     +Yiiv/v     +  w     +   Y.      u5r 
L   m   o  o         vn  o  o         r  v  n  o     o         o         orn  o     oJ 


where: 


3Y 


CRFW 


3v 


p    f    n2  ww 

I 


Or        &  ww  \      t  ' 

-     T^      j    D(x)    dx    )    1 1    H(X)~ 


fw2(x)    +   2v2(x)l 
k    o  o         ' 


dx 


/v    (x)    +  w    (x) 
o  o 


3Y 


CRFW 


3w 


p    (     .  2  ww         >     ,  ,     . 

2  v  J .D(x)    dx;    ' I 


v    (x)w    (x) 
o  o 


/v    (x)    +  w    (x) 
o  o 


dx 


3Y 


CRFW 


3q 


9-  (  o  2  WW  ■>      , 

2  *■*      J    d(x)    dxJ    J£ 


H(x)v    (x)w    (x) 

o  o  , 

x     ■  dx 

/v    (x)    +  w    (x) 
o  o 


3Y 


CRFW 
3r 


-  K-«'raih:)f,'«" 


(2v2(x)    +  w2(x)) 
o o        ; 

}~2  2 

/v    (x)    +  w    (x) 
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III.      Normal   Force    (Heave) 


(m   -   Z*  )Aw   +  my  Ap   -    (Z*    +■  mx    )Aq 
W  G  q  G 


Au[2un{z.   5s   +  Z..5b   +  Z.    +    (n      -    1  )Z.      6s}      + 


2 

u. 


+  ▼„  {(Z     vrt  +  Z        t>     +  Z     r    )      ( - -     2 U 

0    l       w   0  vp2^0  vr   o        v    ~- ,    2  2  2>,3/2j; 


/  2  2  2  (u„  +  v"!   +  w) 

0         0  +  wo 


|wo 


+   wn{z       +    Z|     I L  +    (n       -    1  )Z       }       + 

0l    w  w        w  0  wriJ 


2 
U0 


+  po^(zPPpo  +  zrPro)    C  ;  :  :  :  -  71 — 3 27372  ^ 

/     2  2  2              [u„   +   vrt   +  w    1    ' 

/    u^  +   v„  +  w„             ^    0           0           0J 

0  0  0 


qo| 

+  qJz      +  m   +  Zi     I 6s    +    (nA  -    1  )Z      } 

^0l    q  q      q.  n  rmJ 


2 
u 

c0{Zrrr0   (    7=  \  -     T-2 2 273/2^       + 

/     2  2  2             [u„  +   vrt   +  wj    ' 

/    u„    +  v„  +  w„             *>    0           0           0; 

0  0  0 

(Z      r„   +   Z      jp„  +    2Z      v„) 
r       r       vr    0          vp2^  0             w   0 
Av[u    { — 

/     2  2  2 

r    u„    +   v„    +  w^ 

0  0  0 

9  9  2 

v„(z      r„    +    Z      p«    +   Z      r„p„    +   Z      v„r      +    Z        v   r>      +   Z      V„J 
0^    rr   0  pp  0  vp   0*0  vr   0   0  vp2   0^0  w   0J    i 

f    2  2  2>3/2  '    + 

v    0  0  0J 
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III.      Normal   Force    (Cont. ) 


,                  W0             \*Q                         1 
+      v  J  Z    I     i    -i r     +  • 

°l    W|ql    Kl        ~2 2  J' 2 


0  0  0  0 


3Z 


(z      w  I   +  z   i    iw„  +  (n„  -  Dz   |    i   vo}  +  p  (z z 

ww|    0|  ww      0  0  w  w  n    0    J         ^0V    vp  3 

w 

+  Aw[u.{z      +   Zi     i    -I 1-  +    (r\      -    1 

L    0l    w  w        w  0 


CRFW 


)] 


-    1)Z 


w. 


/    2  2  2^,3/2 

^    0  0  0; 


2  2  2 

[Z     p„  +  Z     r„   +   Z     r   d„   +   Z     v„r„   +  Z      „v„prt   +  Z     r   ") }    + 
^    pp*0  rr   0  rp  0^0  vr   0   0  vp2   0*0  w   0;J 


+  vJz    |     I    /1    +   fwj/vj)   +   Z 

0L    ww  *■    0      0; 


W     V 

0    0 


WW 


2  2 

Iw^l/v.   +  w„ 
0        0  0 


/  ,  x     w  w  n   o     i 

+       ^q    -    U     -    II  }    + 

/    2  2 

/v.    +  w„ 

0  0 


0l    w  q 


wo    qo    wo 


,22  ,22 

»     V-    +  w^  /    V.    +   w^ 

0  0  0  0 


f  2Z    I     i  w      + 
^      ww      0 


ww 


2wn(n      -    1)Z    |     |       •    2wJ 
0     o  w  w  n  oJ 


3Z 

CRFWi 

+     s 1    + 

3w      J 


Ap[uQ  - 


/  2  2  2 

'U„    +    v„    +   w^ 
0  0  0 


(2Z      p„  +  Z      r„  +  Z      _v.)      + 
pp^O  rp   0  vp2    0 


+  V0(Zvp"m)    +  P02mZG   "  q0myG   •  r0nOeG^       + 
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III.      Normal   Force    (Cont. ) 


qo 

+  Aq[un(z      +  m   +   Zi     i.      -i 1-  5s   +    (rt      -    1  )Z      } 

1    ol    q  q  6s     qQ  '0  qn; 


wjz 


/  2  2 

/v_   +  w_      q 


3Z 


+  wj  Z    I     I    f 

0      w  q 


0         °.     1     L   „    -v_  '"CRFW 


ArKh 


,2  2  2 

/uo  +  vo  +  wo 


(2Z      r_    +   Z     pn   +   Z     v„)} 

rr   0  rp   0  vr   0   ' 


3Z 


-  pnmx„  -  q«my,*  + 


CRFW 


'0""G        n0~*G  3r 

+  4<j>    [-(WTOT   -   B)    cos    9      sin   <j>    ] 

+  A9    [-(WTOT   -   B)    sin   9      cos    <J>    ] 


r  2  111 

+  A6s  [(Z5s  +   (nQ  -  m5sn)u0  +  Z|q|5su0|q0|]     + 
+  A6b   [Z5bUoJ      + 


v„   +  w„  +  Z.      u   5s    1 
L   qn   o*o        wn   o  o        wiwin  o     0         0         6sn  o     0J 


where: 


3Z 


CRFW 


3v 


o  Z  W      (X)V.(X) 

•    2  ^    TI5oo^'  /»  D"°  7=  i       dx 

/v^(x)    +  w    fx) 


3Z 


CRFW 


3w 


2  2 

Z                                   (v_(x)  +   2w    (x)J 

p    ^    „2             ww         ^     f      „,    »         0  0         -* 

2   ^  JnD(x      dx        4 


/   2  2 

/v    (x)    +  w    (x) 
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3Z 


CRFW 


3q 


|(£        JD(X)     dx^     ^XD(^ 


(vp(x)    +   2w*(x)) 

/   2.    .  2,    . 

/v    (x)    +  w    (x) 


dx 


3Z 


CRFW 


3r 


£_    r  2  WW  N       / 

2  ^  J    D(x)    dxJ    J4 


D(x)    w    (x)    v    (x) 
x  dx 


/   2,    .  2 

/v 


Q(x)     +   WQ(X) 


IV.      Rolling  Torque 


-[mz„   +  K»]Av  +  my„Aw  +    [I      -   K« ]Ap  -    I     Aq  -    [I        +  K» ]Ar      = 
G         v  G  xpxy  xzr 


Au[2u   (k*    +  K.    6rn   +    (nA   -    1)K.      + 
1      0l  5r     0  0  *n 


i<K4+    sin   4Kn  +  K«^   sin   8^nl 


tOv"4t  "Tt0    '    ""8t   ~  rt0 

ri.     ~ir 

\  '    (K4t   Sin   4*t. 


+  vJk     -    23 
0l    v 


2  2 

w 

*   +  -^  '    <**■   sin   4^n  +  K«t-   sin   8^n'}    + 


tO  /       2 

0  0 


r0  p  0      G  0      G  o   G  r        o 


Av[uQ    { 


2v  8 

crto 


/   2  2 

/v  „  +  w   _ 

to        to 


Vtowto 

(K4t sin  4*to +  V  sin  8*to}  + r 

vto  +  wto 


(4K        sin   4<h        +   8KQfc   sin 


)    +   K    }    +   vn{K    I     |(7l    +  -|  +  °         )} 


vn        ,    2  2 

0        /vQ  +  wQ 


+  3t0{(K4t   sin   4*tQ   +   K8t   sin    8*t()>2vt0   + 

+  WtO(4K4t   COS    ^tO   +   K8t    8   COS    ♦tO^    + 
+  W0Kuw   "  P0myG   +   Kvqq0^    + 
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IV.      Rolling   Torque    (Cont. ) 


^to^to 


AWEU0{      2  =  ^K4t   Sin   4*t0   +   K8t   Sin    8*t0) 

v   „    +  w  „ 

to        to 


2 

uo  tovto    f 

- -  («        cos    4^0   +   8K        cos    8*      )} 

vto  +  wto 


0l    \ 


+   vj  K         + 
vw 


K    I     iwn 
v  v      0 


/  2  2 

0  0 


+   ^O^tO^t    "    Sln    4*t0   +   K8t    Sln    8*t0} 
-   vtQ(4K4t   cos    4*tQ   +   8K8t   cos   *t0)}    + 


+  p.(K        -  mz    )    +  r„K  + 

c0     wp  G  0  wrJ 


+  Ap[u„k      -  v^my„   +  w   (k        -  mz    1    +   2k    i     i  Ip, 

^L  o  p        o  jg        o1  wp         gj  p  p  rc 


+  q    (I         +   K      )    -  r_I      ]    + 

0      yz  pq  0   xyJ 

»    r     f  r   2wostoxtowto         „      a2  , 

*  Aq[u0{myG   -   (  -  -  +    2wt0gt0). 

/vto  +  wto 


(k,^    sin    44    „   +   K        sin    8<b      1    + 


4u   v     x 

+  ~2 r   (K4t   COS    4*t0   +   K8t    2   COS    ^to'J    + 

vto  +  wto 


+  vJk      }    +  p    (i        +   K      }    -  q„2I        ■+■  r„{(I      -    I    )    + 
0l    vqJ         c0[    yz  pqJ         ^0      yz  0l      y  z 

+   Kqr    +    48tOVtOXtO(K4t    C°S    4*t0    +    K8t    2    C°S    8*t0^    < 
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IV.   Rolling  Torque  (Cont. ) 

r  r         28tovtoxto 
+  Ar[u0{mzG  +  Kr  +   -         (k4t  sin  44  tQ  +  kQt  sin  84  tQ)  + 

/vto  +  wto 


2 

+      Y°  ^^      UK4t  *t0  +   8K8t  COS   8*t0}}    +  Vwr   "  Vxy   + 

r  «    +  w  ~ 

to        to 


+  ^(Iy"   V    +Kqr}    "r02IyZ   + 

+    2vtOXtOBtO(K8t   Sin   ^tO  +  K8t  Sin   8*t0} 

+  S    „w     x      (4K        cos    4*    „   +   8K        cos    84       )  1 
tO   tO   tO        4t  Yt0  8t  yt0    J 

+  A4    [-(y   WTOT   -  y   B)    cos    9      sin   4      -    (z   WTOT   -  z    B)    cos    4      cos    9    ]    + 
+  A9    [(z   WTOT   -  z    B)    sin   9      sin   A      -    (y   WTOT   -  y   B)    sin   9      cos    4    ]    + 

+  A6r   tK5rU^ 
+  AT1    [%$ 
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V.      Pitching  Torque 


mz   Au   -    (mx„   +  M»  )Aw 
G  G         w 


I     Ap  +    [I      -  M«]Aq   -    I     Ar 

xy  y        q  yz 


"     Aut2u    <M*    +  M5s6S0   +  m6b6bO   +    (n0   "   1,M«st,6s1    + 


2  2 

0  0 


+    vJ  (M      r„    +   M      p)    +   M      vj     f - - )    + 

0l      vr    0  vp^O  w   0;    >    2  2  2<  3/2 

^    0  0  0; 


+  wJMj   +  Mi     i +    (n      -    DM      }    + 

0l    w  w     w  0  wn J 


2  2 

0           0 
+  Po(M     p_    +   M_   r)    [-= = -l.-fc 


-P2    0      >    2   +      2   +      2^3/2 
0  0  0' 


+  q«fM      -  n«-   +  Ml     I  f      — 

0      q  G  q   5s      q.  0 


6s.   +    (n      -    DM      }    + 
0  qn ' 


r   2         2> 

r„M     r_l  v_   +  w    I 

0  rr   0*-    0  0J  ■, 

(    2  2  2>.Zf2 

^    0  0  0J 


Av   [ 


2  2> 


(« 


2  2  2>3/2 

.    +   v„   +  w    1    ' 
0  0  0J 


(M      (2v0(V   +  w^l    +   vZ] 
1    wv       0^    0  0J  0J 


-  v„(m     r„  +  M     p„  +  M     r_v_  +  M     v,_p,_+  M     -r^p.ll 
01    rr    0  pp   0  vr    0   0  vp   CrO        rp2    (rOJi 


;  2         2         2 

'u~   +   v~   +  w~ 
0  0  0 


(M     r.   +  M     pn  +  M     rA)    + 
rr    0  vp^O  vr   0 


/  2  2 

vvn   +  w^ 

0  0 


(Ml     I    q„    +   M    I     iw„   +   M        w_ 
1      w  q    0  ww      0  ww  |    0| 


3M 


+    (n.    -    DM        w.^    +  p„mx„   +   r^mz^   +  r— 

0  wwn    0J         *0      G  0      G  3v 


CRFW 
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V.      Pitching  Torque    (Cont. ) 


+  AWtU0   h~2 2 27572 

(U0  +  vo  +  wo^ 


2  2  0 

(m      p,+   M      r.    +    M      v_r  +   M      vd„    +   M        v   d      +   M      v   1 
v    pp*0          rr   0          vr  0   0  vp  CTO  rp2   0*0  w   0J 

w  w 

+  M      +   Mi     I    1 r  +    (n„    -  1)M      }    +  - • 

w  ww.  0  wn J  r-z r 

I     0|  [2  2 

/v.   +  w„ 


0  0 


f Ml     i    q„    +   M 

1      w  q    0  w 


f  2w„   +   v.l  f2w„   +   v.") 

*>       0  0J         ..        v      0  0J 


w  w. 


+   M 


WW  w. 


+   (n„  -  Dm   , 

0  w  w  n  w 


f       2  2n 

^     0  +  Vi 

-}    -   mz_qr    + 


3M, 


G^O  3w 


Ap    [■ 


/  2  2  2 

/uo  +  vo  +  wo 


(2M      p.    +  M      v.    +  M        r_)    +   mx.v. 
pp    0  vp    0  rp2    0  GO 


-    2p    I        -  q    I        +    (I      -    I      +  M      )r.J    + 
0   zx  0  zy  z  x  rp      0J 


qo 

+  Aqfu  Jm      -   mx„   +    (n„    -    1 )M         +  Mi     i.       I        I    6s.} 
1    0l    q  G  0  qn  q   6s     q  0J 


+    V0M|w|q  /1     +  -2    "    VO    "    VO    +    ^qlql  l^ol     + 

Mq         v0  II 


3M 


+   I      r„   + 


CRFW 


xy    0  3q 


Ar    [- 


,2  2  2 

/uo  +  vo  +  wo 


(M     vn   +  M        d     +   2M     r.)    +  mz    v  + 

vr   0  rp2   0  rr   0  GO 


3M 


+  Prt(I      -   I     +  M      >    +   I    A,   +    2I~rn   + 


CRFW 


0     z  x  rp  xy   0  xz    0  3r 
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V.   Pitching  Torque  (Cont. ) 

+  A<|>    [-(x   WTOT   -   x   B)    cos    9      sin  <j>    ]    + 

+  A9    [ (x  W   -  x   B)    sin   9      cos    <fr      -    (z   WTOT   -  z    B)    cos   9    1    + 
w  o  U  (J  G  3  0 

+  A5s    [(M6s   +M5sn(n0-    D)Uo   +  M|q|58Uo|qoN    + 
+  A6b    tM5bUo] 


Where: 


/  2 


3M 


CRFW 


3v 


+  An    [M      u.q.    +   M      u.w      +  M    |     |    w/v„    +  w^      + 
L    qn    0   0  wn    0    0  w  w  n    0      0  0 

2         i 

+  M.      u_5sJ 

6sn  0     0J 

z 

£.    f  0  2  WW  \       f 

2   ^         J    D(x)    dxJ    >l 


D(x)    wQ(x)    v    (x) 
x  dx 


,2  2 

/v    (x)    +  w    (x) 


3M 


CRFW 


3w 


P      f  .  2  WW  ■>       r 

=      2   (*      J,D(x)    J    U    XDU) 


(v*(x)    +   2Wq(x)) 
/v    (x)    +  w    (x) 


dx 


3M 


CRFW 


3q 


p    r    „  2  ww        •>,-         2  _  .     . 

"     it'1      J    D(x)    dx^    /*X      D(X) 


(v*(x)    +   2w*(x)) 

7~ 2  2 

/v    (x)    +  w    (x) 


3M 


CRFW 


3r 


p    r  „  2  ww        \     f         2  _.     . 

-      2   C*      j    D(x)    cbc)    It   *      D<x) 


WQ(X)    VQ(X) 

]~2  2 

/v    (x)    +  w    (x) 


dx 
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VI.      Yawing  Torque, 


-my„Au   +    (not      -   N»  )Av   -    (I        +  N»  )Ap   -    I     Aq   +    (I      -   N»  )Ar 
G  G  v  zx  p  yz   ^  z  r 


=    Au[2uQ{N*   +  (N5r  +   (n0  -  DN6     )5r0}   + 


rn 


(    2  2n 

w   (v      +  W   ) 

+  vjN      +   N        — — - - +    (n      -    1)N      }    + 

0l    v  vw   ,    2    l      2    A      2s3/2         K^0  '   vn  ' 

^    0  0  0J 


+  N  pn   +   r   [n      -   mx_  +  Ni     i.      5r      +    (n      -    1  )N       I    + 

p  0  0L    r  G  r  6r      r  0  0  rriJ 

r    2         2s 

w  J  w  +  u    J 

+  4v[u    IN      +    N r-TT^  +    (n«    -    DN       } 

L    0l    v  vw   (    2  2  2s3/2  0  vn J 

^    0  0  0J 


/  2  2 

YVn    +    W„ 

0  0 


[Ni     i    rn  +    2N    i     iv-   +   2(n„   -    1)N    i     i    v   1    + 
1      v  r    0  v  v      0  0  v  v  n    0J 


/  2  2 

/vo  +  wo 


JN    I     |W„   +    (ti      -    1  )N    |     i    w    1    + 
1    v  v      0  0  v  v  h    0J 


3N 


+  N._q«  -  m^rn  + 


CRFW 


vq^O  GO  3v 


] 


Aw[u   N 


f    2  2s 

Vuo  +  V 

vw  r    2  2  2s  3/2 


C     ^  <:  ^s 

(  u«  +    v~    +   W,J 
v    0  0  0J 

f N    I     iw  +  (n      -    1 )N    i     |    w   I    + 
1    v  v     0  0  v  v  n    0J 

+  r  Jn 
0^ 


,    2  2 

/v0  +  wo 


N|     I    w^ 

v  r    0 


3N 


wr 


/  2  2 

/v„   +  w„ 
0  0 


+    IHX„Pn    +    N._  Pn    +    ^^n    + 


CRFW 


G^O  wp^O  'G^0  3w 
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VI.   Yawing  Torque  (Cont. ) 


+  Ap[N   ua   +  w    (mx      +   N      )    +    2p    I        +  q   . 
L    p   0  0        G  wp  0   xy  0 

(N       +   I     -   I     +  my„  +  N      )    +  I     r   1 
pq  x  y  JG  pq  yz    0J 

+  Aq[N     v.  +  my _wrt  +    (N        +   I     -   I    )p„ 
L    vq    0  GO  pq  x  y      0 


-21     q„  +  r  fN        -   I      1    + 
xy   0  0*-    qr  zxJ 


3N 


CRFW 


3q 


] 


r 

+  Ar[u_(N      -   mx„   +   Ni     i.      -i t-  Srn   +    (n      -    1  )N      }    + 

L    0l    r  G  r  6r     r  0  0  rnJ 


f  0  N 

+  vJNi     i  1    +  — -  -  my    I    +  N     w„  +   I     p^   + 

0^      v  r  2  GJ  wr    0  yz^O 


+  qn(N        -   I      ] 
0     qr  zx 


3N 
I        I  CRFW 

2N    |     I    r        +  — = 

r  r        0  9r 


+  A<J>    [  (x   WTOT   -   x    B)    cos    9      cos    $    ]    + 

+  A9    [y  WTOT  -  y   B)    cos    9      -    (x  W  -  x  B)    sin   9      sin   A    ]    + 

+  A6r   [(N.      +  N.      («     -   1))u„  +  Ni    I      uJrJ]   + 
L      Sr  5rri      0  0  r   6r    0|    0|  J 


+  An    [*N     u„r„  +  N     u„v„  +  N    I     I    v„/v„  +  wrt  +  N.      u„5r„l 
L  m  o  o        vn  o  o        v  v  n  o     o        o        5rn  o    oJ 


where: 


3N 


CRFW 


3v 


P/-.2  ww         \     f  „#    »         0 

2  k         J,D(X     dx       *  r 


(w*(x)    +   2v2(x)) 


dx 


/   2  2 

/v    (x)    +  wr/x) 


3N 


CRFW 


3w 


2   ^  J,D(X)    dx        * 


vQ(x)    wQ(x) 


•V    (x)    +  WQ(X) 


dx 
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3N 


CRFW 

3q 


P    r  .2  ww         s     (         2„.. 

'     |C*      ]    D(x)    S>    /4    X      H(X) 


VQ(X)    WQ(X) 

/  2.    .  2,     . 

/v0(x)    +  w    (x) 


dx 


3N 


CRFW 
3r 


P   r    »2  ww       >,    ,       2 

'      2   ^      J.D(x)    dx^    /i    X      H(X) 


(wq(x)    +   2v2(x)) 

/~~2  2 

/v    (x)    +  w    (x) 


dx 
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Table   B-l.      Nominal  design  point. 


uQ     (FT/SEC) 


4  7.380 


v0     (FT/ SEC) 


70 


w0     (FT/ SEC) 


0.531 9 


P0     (RAD/SEC) 


-.00003 


q0     (RAD /SEC) 


0.00305 


rG     (RAD /SEC) 


-.01823 


~s0     (DEG) 


-.7350 


6b Q     (DEG) 
0.0000 


£rQ     (DEG) 


.000  0 


PHIQ     (DEG) 
-9. 4520 


THETA.0     (DEG) 


-0.0315b 


RPS 

2.369 
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C-l.    Nonlinear  Simulation  of  ty   -   z  Compensator  for 
Various  Commanded  Inputs 

(The  simulation  in  this  appendix  is  based  on  the  following  table 
of  command  inputs  for  heading  rate,  in  units  of  "tens"  of  degrees,  and 
depth  rate,  in  units  of  0.01  *  feet/s) . 


-imrie 

PS  I  DOT 

Z    C 

>0T 

0. 

-10.000 

0. 

0 

60. 

-10. 000 

0  . 

0 

65. 

-1 5.000 

0  . 

0 

1  20. 

-1 5 . 000 

0  . 

0 

1  25. 

-15.000 

0  , 

0  5 

180. 

-15.000 

0  , 

,05 

1  85  . 

0.000 

0  , 

,  0 

240. 

0  .000 

0 

.  0 

245. 

-5.000 

0 

.0 

290. 

-5.000 

0 

.  0 

295  . 

-5  .000 

- 

.  1 

350. 

-5 . 000 

- 

.  1 

355. 

-1 0.000 

0 

.0 

440  . 

-1 0 .000 

0 

.  0 

445  . 

-15.000 

- 

.  1 

6  00. 

-1 5  .000 

- 

.  1 
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